Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Ddebug.c63 Quaternion ftmpq; // scratch quaternion in ApplyPerturbation() local
69 ftmpq.q0 = 0.0F; in ApplyPerturbation()
70 ftmpq.q1 = 1.0F; in ApplyPerturbation()
71 ftmpq.q2 = 0.0F; in ApplyPerturbation()
72 ftmpq.q3 = 0.0F; in ApplyPerturbation()
77 ftmpq.q0 = 0.0F; in ApplyPerturbation()
78 ftmpq.q1 = 0.0F; in ApplyPerturbation()
79 ftmpq.q2 = 1.0F; in ApplyPerturbation()
80 ftmpq.q3 = 0.0F; in ApplyPerturbation()
85 ftmpq.q0 = 0.0F; in ApplyPerturbation()
[all …]
Dfusion.c537 Quaternion ftmpq; // scratch quaternion in fRun_3DOF_Y_BASIC() local
556 fQuaternionFromRotationVectorDeg(&ftmpq, pthisSV->fOmega, pthisSV->fdeltat); in fRun_3DOF_Y_BASIC()
557 qAeqAxB(&(pthisSV->fq), &ftmpq); in fRun_3DOF_Y_BASIC()
648 Quaternion ftmpq; // scratch quaternion in fRun_6DOF_GY_KALMAN() local
692 fQuaternionFromRotationVectorDeg(&ftmpq, ftmpMi3x1, ftmp); in fRun_6DOF_GY_KALMAN()
693 qAeqAxB(&fqMi, &ftmpq); in fRun_6DOF_GY_KALMAN()
700 fQuaternionFromRotationVectorDeg(&ftmpq, pthisSV->fOmega, in fRun_6DOF_GY_KALMAN()
702 qAeqAxB(&fqMi, &ftmpq); in fRun_6DOF_GY_KALMAN()
754 fveqconjgquq(&ftmpq, ftmp3DOF3x1, ftmpMi3x1); in fRun_6DOF_GY_KALMAN()
755 pthisSV->fZErr[CHX] = ftmpq.q1; in fRun_6DOF_GY_KALMAN()
[all …]