Searched refs:fmMi (Results 1 – 1 of 1) sorted by relevance
1030 float fmMi[3]; // a priori estimate of the geomagnetic vector (sensor frame) in fRun_9DOF_GBY_KALMAN() local1161 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()1175 fveqconjgquq(&ftmpq, ftmpA3x1, fmMi); in fRun_9DOF_GBY_KALMAN()1351 fveqRu(fmPl, ftmpA3x3, fmMi, 0); in fRun_9DOF_GBY_KALMAN()
