Searched refs:fQwCT9x6 (Results 1 – 2 of 2) sorted by relevance
1232 pthisSV->fQwCT9x6[i][j] = 0.0F; in fRun_9DOF_GBY_KALMAN()1249 if (fC6x9jk == 1.0F) pthisSV->fQwCT9x6[i][j] += pthisSV->fQw9x9[i][k]; in fRun_9DOF_GBY_KALMAN()1250 else pthisSV->fQwCT9x6[i][j] += pthisSV->fQw9x9[i][k] * fC6x9jk; in fRun_9DOF_GBY_KALMAN()1277 if ((fC6x9ik != 0.0F) && (pthisSV->fQwCT9x6[k][j] != 0.0F)) { in fRun_9DOF_GBY_KALMAN()1278 if (fC6x9ik == 1.0F) ftmpA6x6[i][j] += pthisSV->fQwCT9x6[k][j]; in fRun_9DOF_GBY_KALMAN()1279 else ftmpA6x6[i][j] += fC6x9ik * pthisSV->fQwCT9x6[k][j]; in fRun_9DOF_GBY_KALMAN()1301 if ((pthisSV->fQwCT9x6[i][k] != 0.0F) && (ftmpA6x6[k][j] != 0.0F)) in fRun_9DOF_GBY_KALMAN()1302 pthisSV->fK9x6[i][j] += pthisSV->fQwCT9x6[i][k] * ftmpA6x6[k][j]; in fRun_9DOF_GBY_KALMAN()
408 float fQwCT9x6[9][6]; ///< Qw.C^T matrix member