Searched refs:fdeltaq (Results 1 – 1 of 1) sorted by relevance
899 Quaternion fdeltaq; // delta rotation quaternion in fLPFOrientationQuaternion() local904 fdeltaq = qconjgAxB(pLPq, pq); in fLPFOrientationQuaternion()905 if (fdeltaq.q0 < 0.0F) in fLPFOrientationQuaternion()907 fdeltaq.q0 = -fdeltaq.q0; in fLPFOrientationQuaternion()908 fdeltaq.q1 = -fdeltaq.q1; in fLPFOrientationQuaternion()909 fdeltaq.q2 = -fdeltaq.q2; in fLPFOrientationQuaternion()910 fdeltaq.q3 = -fdeltaq.q3; in fLPFOrientationQuaternion()915 ftmp = flpf + (1.0F - flpf) * sqrtf(fabs(1.0F - fdeltaq.q0 * fdeltaq.q0)); in fLPFOrientationQuaternion()919 fdeltaq.q1 *= ftmp; in fLPFOrientationQuaternion()920 fdeltaq.q2 *= ftmp; in fLPFOrientationQuaternion()[all …]