Searched refs:fsinDelta6DOF (Results 1 – 1 of 1) sorted by relevance
/hal_nxp-3.6.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/ |
D | fusion.c | 1043 float fsinDelta6DOF; // sin(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() 1125 pthisSV->fsinDeltaPl = fsinDelta6DOF; 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 …]
|