Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dorientation.c697 void fQuaternionFromRotationVectorDeg(Quaternion *pq, const float rvecdeg[], float fscaling) in fQuaternionFromRotationVectorDeg() argument
737 pq->q1 = rvecdeg[CHX] * ftmp; // q1 = nx * sin(eta/2) in fQuaternionFromRotationVectorDeg()
738 pq->q2 = rvecdeg[CHY] * ftmp; // q2 = ny * sin(eta/2) in fQuaternionFromRotationVectorDeg()
739 pq->q3 = rvecdeg[CHZ] * ftmp; // q3 = nz * sin(eta/2) in fQuaternionFromRotationVectorDeg()
744 pq->q1 = pq->q2 = pq->q3 = 0.0F; in fQuaternionFromRotationVectorDeg()
749 fvecsq = pq->q1 * pq->q1 + pq->q2 * pq->q2 + pq->q3 * pq->q3; in fQuaternionFromRotationVectorDeg()
753 pq->q0 = sqrtf(1.0F - fvecsq); in fQuaternionFromRotationVectorDeg()
758 pq->q0 = 0.0F; in fQuaternionFromRotationVectorDeg()
765 void fQuaternionFromRotationMatrix(float R[][3], Quaternion *pq) in fQuaternionFromRotationMatrix() argument
772 pq->q0 = sqrtf(fabsf(fq0sq)); in fQuaternionFromRotationMatrix()
[all …]
Dorientation.h122 Quaternion *pq ///< Quaternion (output)
127 const Quaternion *pq ///< Quaternion (input)
155 Quaternion *pq, ///< quaternion (output)
161 Quaternion *pq, ///< quaternion (input)
166 Quaternion *pq,