Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Ddebug.c50 .q2 = 0.0, in ApplyPerturbation()
56 .q2 = 0.0, in ApplyPerturbation()
71 ftmpq.q2 = 0.0F; in ApplyPerturbation()
79 ftmpq.q2 = 1.0F; in ApplyPerturbation()
87 ftmpq.q2 = 0.0F; in ApplyPerturbation()
95 ftmpq.q2 = 0.0F; in ApplyPerturbation()
103 ftmpq.q2 = 0.0F; in ApplyPerturbation()
111 ftmpq.q2 = -ONEOVERSQRT2; in ApplyPerturbation()
119 ftmpq.q2 = ONEOVERSQRT2; in ApplyPerturbation()
127 ftmpq.q2 = 0.0F; in ApplyPerturbation()
[all …]
Dorientation.c738 pq->q2 = rvecdeg[CHY] * ftmp; // q2 = ny * 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()
780 pq->q2 = recip4q0 * (R[CHZ][CHX] - R[CHX][CHZ]); in fQuaternionFromRotationMatrix()
789 pq->q2 = sqrtf(fabsf(0.5F + 0.5F * R[CHY][CHY] - fq0sq)); in fQuaternionFromRotationMatrix()
794 if ((R[CHZ][CHX] - R[CHX][CHZ]) < 0.0F) pq->q2 = -pq->q2; in fQuaternionFromRotationMatrix()
818 f2q0q2 = f2q * pq->q2; in fRotationMatrixFromQuaternion()
823 f2q1q2 = f2q * pq->q2; in fRotationMatrixFromQuaternion()
826 f2q = 2.0F * pq->q2; in fRotationMatrixFromQuaternion()
827 f2q2q2 = f2q * pq->q2; 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()
756 pthisSV->fZErr[CHY] = ftmpq.q2; in fRun_6DOF_GY_KALMAN()
940 ftmpq.q2 = -pthisSV->fqgErrPl[CHY]; in fRun_6DOF_GY_KALMAN()
942 ftmp = ftmpq.q1 * ftmpq.q1 + ftmpq.q2 * ftmpq.q2 + ftmpq.q3 * ftmpq.q3; in fRun_6DOF_GY_KALMAN()
956 ftmpq.q2 *= ftmp; in fRun_6DOF_GY_KALMAN()
1152 pthisSV->fZErr[1] = ftmpq.q2; in fRun_9DOF_GBY_KALMAN()
1177 pthisSV->fZErr[4] = ftmpq.q2; in fRun_9DOF_GBY_KALMAN()
1333 ftmpq.q2 = -pthisSV->fqgErrPl[CHY]; in fRun_9DOF_GBY_KALMAN()
1335 ftmpq.q0 = sqrtf(fabs(1.0F - ftmpq.q1 * ftmpq.q1 - ftmpq.q2 * ftmpq.q2 - ftmpq.q3 * ftmpq.q3)); in fRun_9DOF_GBY_KALMAN()
[all …]
Dorientation.h24 float q2; ///< y vector component member
Doutput_stream.c309 fq.q1 = fq.q2 = fq.q3 = 0.0F; in CreateAndSendPackets()
395 scratch16 = (int16_t) (fq.q2 * 30000.0F); in CreateAndSendPackets()
/hal_nxp-3.5.0/mcux/mcux-sdk/CMSIS/DSP/Source/QuaternionMathFunctions/
Darm_rotation2quaternion_f32.c70 #define R11 vgetq_lane(q2,0)
71 #define R12 vgetq_lane(q2,1)
72 #define R20 vgetq_lane(q2,2)
73 #define R21 vgetq_lane(q2,3)
81 f32x4_t q1,q2, q; in arm_rotation2quaternion_f32() local
93 q2 = vld1q(pInputRotations); in arm_rotation2quaternion_f32()
108 q2 = vmulq_n_f32(q2,s); in arm_rotation2quaternion_f32()
122 q2 = vmulq_n_f32(q2,s); in arm_rotation2quaternion_f32()
136 q2 = vmulq_n_f32(q2,s); in arm_rotation2quaternion_f32()
150 q2 = vmulq_n_f32(q2,s); in arm_rotation2quaternion_f32()
/hal_nxp-3.5.0/mcux/mcux-sdk/.github/ISSUE_TEMPLATE/
Dbug_report.md19 - Toolchain: [e.g. ARMGCC 9-2020-q2-update]
/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()
379 scratch16 = (int16_t) (fq.q2 * 30000.0F); in encodeOrientPacketStream()
Dorientaion_application_baremetal_agm04.c359 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
378 scratch16 = (int16_t) (fq.q2 * 30000.0F); in encodeOrientPacketStream()
Dorientaion_application_baremetal_agmp03.c358 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
377 scratch16 = (int16_t) (fq.q2 * 30000.0F); in encodeOrientPacketStream()