Quat2EulerDegree_fx(*Quaternions_ref,&Quaternions_abs.z_fx,&Quaternions_abs.y_fx,&Quaternions_abs.x_fx);/*order in Quat2Euler seems to be reversed ?*/
Quat2EulerDegree_fx(Quaternions_ref,&Quaternions_ref2.z_fx,&Quaternions_ref2.y_fx,&Quaternions_ref2.x_fx);/*order in Quat2Euler seems to be reversed ?*/
/*interpolation if actual pose is not same as one of assumed poses*/
/*get the deviation*/
Quat2EulerDegree_fx(*Quaternions_ref,&quaternions_ref_euler.z_fx,&quaternions_ref_euler.y_fx,&quaternions_ref_euler.x_fx);/*order in Quat2Euler seems to be reversed ?*/
Quat2EulerDegree_fx(quaternions_ref_q22,&quaternions_ref_euler.z_fx,&quaternions_ref_euler.y_fx,&quaternions_ref_euler.x_fx);/*order in Quat2Euler seems to be reversed ?*/