Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dorientation.c767 float fq0sq; // q0^2 in fQuaternionFromRotationMatrix() local
771 fq0sq = 0.25F * (1.0F + R[CHX][CHX] + R[CHY][CHY] + R[CHZ][CHZ]); in fQuaternionFromRotationMatrix()
772 pq->q0 = sqrtf(fabsf(fq0sq)); in fQuaternionFromRotationMatrix()
788 pq->q1 = sqrtf(fabsf(0.5F + 0.5F * R[CHX][CHX] - fq0sq)); in fQuaternionFromRotationMatrix()
789 pq->q2 = sqrtf(fabsf(0.5F + 0.5F * R[CHY][CHY] - fq0sq)); in fQuaternionFromRotationMatrix()
790 pq->q3 = sqrtf(fabsf(0.5F + 0.5F * R[CHZ][CHZ] - fq0sq)); in fQuaternionFromRotationMatrix()