Home
last modified time | relevance | path

Searched refs:fdeltaq (Results 1 – 1 of 1) sorted by relevance

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dorientation.c899 Quaternion fdeltaq; // delta rotation quaternion in fLPFOrientationQuaternion() local
904 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 …]