Searched refs:ftmpA6x6 (Results 1 – 1 of 1) sorted by relevance
1026 float ftmpA6x6[6][6]; // scratch 6x6 matrix in fRun_9DOF_GBY_KALMAN() local1260 if (i == j) ftmpA6x6[i][j] = pthisSV->fQv6x1[i]; in fRun_9DOF_GBY_KALMAN()1261 else ftmpA6x6[i][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()1287 ftmpA6x6[i][j] = ftmpA6x6[j][i]; in fRun_9DOF_GBY_KALMAN()1291 pfRows[i] = ftmpA6x6[i]; 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()
