Searched refs:fRMi (Results 1 – 1 of 1) sorted by relevance
1027 float fRMi[3][3]; // a priori orientation matrix in fRun_9DOF_GBY_KALMAN() local1091 fRotationMatrixFromQuaternion(fRMi, &fqMi); in fRun_9DOF_GBY_KALMAN()1123 f3x3matrixAeqB(fRMi, fR6DOF); in fRun_9DOF_GBY_KALMAN()1136 fgMi[CHX] = fRMi[CHX][CHZ]; in fRun_9DOF_GBY_KALMAN()1137 fgMi[CHY] = fRMi[CHY][CHZ]; in fRun_9DOF_GBY_KALMAN()1138 fgMi[CHZ] = fRMi[CHZ][CHZ]; in fRun_9DOF_GBY_KALMAN()1143 fgMi[CHX] = -fRMi[CHX][CHZ]; in fRun_9DOF_GBY_KALMAN()1144 fgMi[CHY] = -fRMi[CHY][CHZ]; in fRun_9DOF_GBY_KALMAN()1145 fgMi[CHZ] = -fRMi[CHZ][CHZ]; in fRun_9DOF_GBY_KALMAN()1161 fmMi[CHX] = fRMi[CHX][CHX] * pthisSV->fcosDeltaPl + fRMi[CHX][CHZ] * pthisSV->fsinDeltaPl; in fRun_9DOF_GBY_KALMAN()[all …]
