Searched refs:fC6x9ik (Results 1 – 1 of 1) sorted by relevance
1037 float fC6x9ik; // element i, k of measurement matrix C in fRun_9DOF_GBY_KALMAN() local1265 fC6x9ik = 0.0F; in fRun_9DOF_GBY_KALMAN()1268 if (k == i) fC6x9ik = 1.0F; in fRun_9DOF_GBY_KALMAN()1269 if (k == (i + 6)) fC6x9ik = -pthisSV->fAlphaOver2; in fRun_9DOF_GBY_KALMAN()1272 if (k == i) fC6x9ik = 1.0F; in fRun_9DOF_GBY_KALMAN()1273 if (k == (i + 3)) fC6x9ik = -pthisSV->fAlphaOver2; 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()
