Searched refs:fcosDeltaPl (Results 1 – 2 of 2) sorted by relevance
/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/ |
D | fusion.c | 396 …feCompassNED(pthisSV->fRPl, &(pthisSV->fDeltaPl), &(pthisSV->fsinDeltaPl), &(pthisSV->fcosDeltaPl), in fInit_9DOF_GBY_KALMAN() 399 …passAndroid(pthisSV->fRPl, &(pthisSV->fDeltaPl), &(pthisSV->fsinDeltaPl), &(pthisSV->fcosDeltaPl), in fInit_9DOF_GBY_KALMAN() 402 …eCompassWin8(pthisSV->fRPl, &(pthisSV->fDeltaPl), &(pthisSV->fsinDeltaPl), &(pthisSV->fcosDeltaPl), in fInit_9DOF_GBY_KALMAN() 1126 pthisSV->fcosDeltaPl = fcosDelta6DOF; in fRun_9DOF_GBY_KALMAN() 1161 fmMi[CHX] = fRMi[CHX][CHX] * pthisSV->fcosDeltaPl + fRMi[CHX][CHZ] * pthisSV->fsinDeltaPl; in fRun_9DOF_GBY_KALMAN() 1162 fmMi[CHY] = fRMi[CHY][CHX] * pthisSV->fcosDeltaPl + fRMi[CHY][CHZ] * pthisSV->fsinDeltaPl; in fRun_9DOF_GBY_KALMAN() 1163 fmMi[CHZ] = fRMi[CHZ][CHX] * pthisSV->fcosDeltaPl + fRMi[CHZ][CHZ] * pthisSV->fsinDeltaPl; in fRun_9DOF_GBY_KALMAN() 1168 fmMi[CHX] = fRMi[CHX][CHY] * pthisSV->fcosDeltaPl - fRMi[CHX][CHZ] * pthisSV->fsinDeltaPl; in fRun_9DOF_GBY_KALMAN() 1169 fmMi[CHY] = fRMi[CHY][CHY] * pthisSV->fcosDeltaPl - fRMi[CHY][CHZ] * pthisSV->fsinDeltaPl; in fRun_9DOF_GBY_KALMAN() 1170 fmMi[CHZ] = fRMi[CHZ][CHY] * pthisSV->fcosDeltaPl - fRMi[CHZ][CHZ] * pthisSV->fsinDeltaPl; in fRun_9DOF_GBY_KALMAN() [all …]
|
D | sensor_fusion.h | 413 float fcosDeltaPl; ///< cos(fDeltaPl) member
|