Searched refs:fLPq (Results 1 – 3 of 3) sorted by relevance
/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/ |
D | debug.c | 151 CurrentQ = sfg->SV_3DOF_G_BASIC.fLPq; in ApplyPerturbation() 152 qAeqAxB(&(sfg->SV_3DOF_G_BASIC.fLPq), &ftmpq); in ApplyPerturbation() 157 CurrentQ = sfg->SV_3DOF_B_BASIC.fLPq; in ApplyPerturbation() 158 qAeqAxB(&(sfg->SV_3DOF_B_BASIC.fLPq), &ftmpq); in ApplyPerturbation() 169 CurrentQ = sfg->SV_6DOF_GB_BASIC.fLPq; in ApplyPerturbation() 170 qAeqAxB(&(sfg->SV_6DOF_GB_BASIC.fLPq), &ftmpq); in ApplyPerturbation()
|
D | sensor_fusion.h | 280 Quaternion fLPq; ///< low pass filtered orientation quaternion member 302 Quaternion fLPq; ///< low pass filtered orientation quaternion member 343 Quaternion fLPq; ///< low pass filtered orientation quaternion member
|
D | fusion.c | 199 fQuaternionFromRotationMatrix(pthisSV->fLPR, &(pthisSV->fLPq)); in fInit_3DOF_G_BASIC() 227 fQuaternionFromRotationMatrix(pthisSV->fLPR, &(pthisSV->fLPq)); in fInit_3DOF_B_BASIC() 273 fQuaternionFromRotationMatrix(pthisSV->fLPR, &(pthisSV->fLPq)); in fInit_6DOF_GB_BASIC() 460 fLPFOrientationQuaternion(&(pthisSV->fq), &(pthisSV->fLPq), pthisSV->flpf, in fRun_3DOF_G_BASIC() 464 fRotationMatrixFromQuaternion(pthisSV->fLPR, &(pthisSV->fLPq)); in fRun_3DOF_G_BASIC() 465 fRotationVectorDegFromQuaternion(&(pthisSV->fLPq), pthisSV->fLPRVec); in fRun_3DOF_G_BASIC() 509 fLPFOrientationQuaternion(&(pthisSV->fq), &(pthisSV->fLPq), pthisSV->flpf, in fRun_3DOF_B_BASIC() 513 fRotationMatrixFromQuaternion(pthisSV->fLPR, &(pthisSV->fLPq)); in fRun_3DOF_B_BASIC() 514 fRotationVectorDegFromQuaternion(&(pthisSV->fLPq), pthisSV->fLPRVec); in fRun_3DOF_B_BASIC() 606 fLPFOrientationQuaternion(&(pthisSV->fq), &(pthisSV->fLPq), pthisSV->flpf, in fRun_6DOF_GB_BASIC() [all …]
|