Searched refs:fcosDelta6DOF (Results 1 – 1 of 1) sorted by relevance
| /hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/ |
| D | fusion.c | 1044 float fcosDelta6DOF; // cos(fDelta6DOF) in fRun_9DOF_GBY_KALMAN() local
1096 …feCompassNED(fR6DOF, &fDelta6DOF, &fsinDelta6DOF, &fcosDelta6DOF, pthisMag->fBc, pthisAccel->fGc, … in fRun_9DOF_GBY_KALMAN()
1098 …feCompassAndroid(fR6DOF, &fDelta6DOF, &fsinDelta6DOF, &fcosDelta6DOF, pthisMag->fBc, pthisAccel->f… in fRun_9DOF_GBY_KALMAN()
1100 …feCompassWin8(fR6DOF, &fDelta6DOF, &fsinDelta6DOF, &fcosDelta6DOF, pthisMag->fBc, pthisAccel->fGc,… in fRun_9DOF_GBY_KALMAN()
1126 pthisSV->fcosDeltaPl = fcosDelta6DOF; in fRun_9DOF_GBY_KALMAN()
1158 ftmpA3x1[CHX] = fR6DOF[CHX][CHX] * fcosDelta6DOF + fR6DOF[CHX][CHZ] * fsinDelta6DOF; in fRun_9DOF_GBY_KALMAN()
1159 ftmpA3x1[CHY] = fR6DOF[CHY][CHX] * fcosDelta6DOF + fR6DOF[CHY][CHZ] * fsinDelta6DOF; in fRun_9DOF_GBY_KALMAN()
1160 ftmpA3x1[CHZ] = fR6DOF[CHZ][CHX] * fcosDelta6DOF + fR6DOF[CHZ][CHZ] * fsinDelta6DOF; in fRun_9DOF_GBY_KALMAN()
1165 ftmpA3x1[CHX] = fR6DOF[CHX][CHY] * fcosDelta6DOF - fR6DOF[CHX][CHZ] * fsinDelta6DOF; in fRun_9DOF_GBY_KALMAN()
1166 ftmpA3x1[CHY] = fR6DOF[CHY][CHY] * fcosDelta6DOF - fR6DOF[CHY][CHZ] * fsinDelta6DOF; in fRun_9DOF_GBY_KALMAN()
[all …]
|
