Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Ddebug.c51 .q3 = 0.0 in ApplyPerturbation()
57 .q3 = 0.0 in ApplyPerturbation()
72 ftmpq.q3 = 0.0F; in ApplyPerturbation()
80 ftmpq.q3 = 0.0F; in ApplyPerturbation()
88 ftmpq.q3 = 1.0F; in ApplyPerturbation()
96 ftmpq.q3 = 0.0F; in ApplyPerturbation()
104 ftmpq.q3 = 0.0F; in ApplyPerturbation()
112 ftmpq.q3 = 0.0F; in ApplyPerturbation()
120 ftmpq.q3 = 0.0F; in ApplyPerturbation()
128 ftmpq.q3 = -ONEOVERSQRT2; in ApplyPerturbation()
[all …]
Dorientation.c739 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()
781 pq->q3 = recip4q0 * (R[CHX][CHY] - R[CHY][CHX]); in fQuaternionFromRotationMatrix()
790 pq->q3 = sqrtf(fabsf(0.5F + 0.5F * R[CHZ][CHZ] - fq0sq)); in fQuaternionFromRotationMatrix()
795 if ((R[CHX][CHY] - R[CHY][CHX]) < 0.0F) pq->q3 = -pq->q3; in fQuaternionFromRotationMatrix()
819 f2q0q3 = f2q * pq->q3; in fRotationMatrixFromQuaternion()
824 f2q1q3 = f2q * pq->q3; in fRotationMatrixFromQuaternion()
828 f2q2q3 = f2q * pq->q3; in fRotationMatrixFromQuaternion()
829 f2q3q3 = 2.0F * pq->q3 * pq->q3; in fRotationMatrixFromQuaternion()
[all …]
Dfusion.c738 ftmpMi3x1[CHX] = 2.0F * (fqMi.q1 * fqMi.q3 - fqMi.q0 * fqMi.q2); in fRun_6DOF_GY_KALMAN()
739 ftmpMi3x1[CHY] = 2.0F * (fqMi.q2 * fqMi.q3 + fqMi.q0 * fqMi.q1); in fRun_6DOF_GY_KALMAN()
740 ftmpMi3x1[CHZ] = 2.0F * (fqMi.q0 * fqMi.q0 + fqMi.q3 * fqMi.q3) - 1.0F; in fRun_6DOF_GY_KALMAN()
757 pthisSV->fZErr[CHZ] = ftmpq.q3; in fRun_6DOF_GY_KALMAN()
941 ftmpq.q3 = -pthisSV->fqgErrPl[CHZ]; in fRun_6DOF_GY_KALMAN()
942 ftmp = ftmpq.q1 * ftmpq.q1 + ftmpq.q2 * ftmpq.q2 + ftmpq.q3 * ftmpq.q3; in fRun_6DOF_GY_KALMAN()
957 ftmpq.q3 *= ftmp; in fRun_6DOF_GY_KALMAN()
1153 pthisSV->fZErr[2] = ftmpq.q3; in fRun_9DOF_GBY_KALMAN()
1178 pthisSV->fZErr[5] = ftmpq.q3; in fRun_9DOF_GBY_KALMAN()
1334 ftmpq.q3 = -pthisSV->fqgErrPl[CHZ]; in fRun_9DOF_GBY_KALMAN()
[all …]
Dorientation.h25 float q3; ///< z vector component member
Doutput_stream.c309 fq.q1 = fq.q2 = fq.q3 = 0.0F; in CreateAndSendPackets()
397 scratch16 = (int16_t) (fq.q3 * 30000.0F); in CreateAndSendPackets()
/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/driverexamples/demos/
Dorientaion_application_baremetal_agm01.c360 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
381 scratch16 = (int16_t) (fq.q3 * 30000.0F); in encodeOrientPacketStream()
Dorientaion_application_baremetal_agm04.c359 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
380 scratch16 = (int16_t) (fq.q3 * 30000.0F); in encodeOrientPacketStream()
Dorientaion_application_baremetal_agmp03.c358 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
379 scratch16 = (int16_t) (fq.q3 * 30000.0F); in encodeOrientPacketStream()