Searched refs:fQw9x9 (Results 1 – 2 of 2) sorted by relevance
1186 pthisSV->fQw9x9[i][j] = 0.0F; in fRun_9DOF_GBY_KALMAN()1188 pthisSV->fQw9x9[6][6] = pthisSV->fbErrPl[CHX] * pthisSV->fbErrPl[CHX]; in fRun_9DOF_GBY_KALMAN()1189 pthisSV->fQw9x9[7][7] = pthisSV->fbErrPl[CHY] * pthisSV->fbErrPl[CHY]; in fRun_9DOF_GBY_KALMAN()1190 pthisSV->fQw9x9[8][8] = pthisSV->fbErrPl[CHZ] * pthisSV->fbErrPl[CHZ]; in fRun_9DOF_GBY_KALMAN()1192 ftmpA3x1[0] = pthisSV->fAlphaSqOver4 * pthisSV->fQw9x9[6][6] + pthisSV->fAlphaSqQvYQwbOver12; in fRun_9DOF_GBY_KALMAN()1193 ftmpA3x1[1] = pthisSV->fAlphaSqOver4 * pthisSV->fQw9x9[7][7] + pthisSV->fAlphaSqQvYQwbOver12; in fRun_9DOF_GBY_KALMAN()1194 ftmpA3x1[2] = pthisSV->fAlphaSqOver4 * pthisSV->fQw9x9[8][8] + pthisSV->fAlphaSqQvYQwbOver12; in fRun_9DOF_GBY_KALMAN()1196 pthisSV->fQw9x9[0][0] = pthisSV->fqgErrPl[CHX] * pthisSV->fqgErrPl[CHX] + ftmpA3x1[0]; in fRun_9DOF_GBY_KALMAN()1197 pthisSV->fQw9x9[1][1] = pthisSV->fqgErrPl[CHY] * pthisSV->fqgErrPl[CHY] + ftmpA3x1[1]; in fRun_9DOF_GBY_KALMAN()1198 pthisSV->fQw9x9[2][2] = pthisSV->fqgErrPl[CHZ] * pthisSV->fqgErrPl[CHZ] + ftmpA3x1[2]; in fRun_9DOF_GBY_KALMAN()[all …]
406 float fQw9x9[9][9]; ///< covariance matrix Qw member
