Home
last modified time | relevance | path

Searched refs:fqPl (Results 1 – 3 of 3) sorted by relevance

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Ddebug.c175 CurrentQ = sfg->SV_6DOF_GY_KALMAN.fqPl; in ApplyPerturbation()
176 qAeqAxB(&(sfg->SV_6DOF_GY_KALMAN.fqPl), &ftmpq); in ApplyPerturbation()
181 CurrentQ = sfg->SV_9DOF_GBY_KALMAN.fqPl; in ApplyPerturbation()
182 qAeqAxB(&(sfg->SV_9DOF_GBY_KALMAN.fqPl), &ftmpq); in ApplyPerturbation()
Dfusion.c337 fQuaternionFromRotationMatrix(pthisSV->fRPl, &(pthisSV->fqPl)); in fInit_6DOF_GY_KALMAN()
405 fQuaternionFromRotationMatrix(pthisSV->fRPl, &(pthisSV->fqPl)); in fInit_9DOF_GBY_KALMAN()
676 fqMi = pthisSV->fqPl; in fRun_6DOF_GY_KALMAN()
961 qAeqBxC(&(pthisSV->fqPl), &fqMi, &ftmpq); in fRun_6DOF_GY_KALMAN()
964 fqAeqNormqA(&(pthisSV->fqPl)); in fRun_6DOF_GY_KALMAN()
965 fRotationMatrixFromQuaternion(pthisSV->fRPl, &(pthisSV->fqPl)); in fRun_6DOF_GY_KALMAN()
966 fRotationVectorDegFromQuaternion(&(pthisSV->fqPl), pthisSV->fRVecPl); in fRun_6DOF_GY_KALMAN()
1070 fqMi = pthisSV->fqPl; in fRun_9DOF_GBY_KALMAN()
1122 fqMi = pthisSV->fqPl = fq6DOF; in fRun_9DOF_GBY_KALMAN()
1370 fQuaternionFromRotationMatrix(pthisSV->fRPl, &(pthisSV->fqPl)); in fRun_9DOF_GBY_KALMAN()
[all …]
Dsensor_fusion.h367 Quaternion fqPl; ///< a posteriori orientation quaternion member
401 Quaternion fqPl; ///< a posteriori orientation quaternion member