Searched refs:fsinDeltaPl (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 …feCompassAndroid(pthisSV->fRPl, &(pthisSV->fDeltaPl), &(pthisSV->fsinDeltaPl), &(pthisSV->fcosDel… in fInit_9DOF_GBY_KALMAN() 402 …feCompassWin8(pthisSV->fRPl, &(pthisSV->fDeltaPl), &(pthisSV->fsinDeltaPl), &(pthisSV->fcosDeltaPl… in fInit_9DOF_GBY_KALMAN() 1125 pthisSV->fsinDeltaPl = fsinDelta6DOF; 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 | 412 float fsinDeltaPl; ///< sin(fDeltaPl) member
|