Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dorientation.c768 float recip4q0; // 1/4q0 in fQuaternionFromRotationMatrix() local
778 recip4q0 = 0.25F / pq->q0; in fQuaternionFromRotationMatrix()
779 pq->q1 = recip4q0 * (R[CHY][CHZ] - R[CHZ][CHY]); in fQuaternionFromRotationMatrix()
780 pq->q2 = recip4q0 * (R[CHZ][CHX] - R[CHX][CHZ]); in fQuaternionFromRotationMatrix()
781 pq->q3 = recip4q0 * (R[CHX][CHY] - R[CHY][CHX]); in fQuaternionFromRotationMatrix()