Home
last modified time | relevance | path

Searched refs:fC6x9jk (Results 1 – 1 of 1) sorted by relevance

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c1038 float fC6x9jk; // element j, k of measurement matrix C in fRun_9DOF_GBY_KALMAN() local
1236 fC6x9jk = 0.0F; in fRun_9DOF_GBY_KALMAN()
1239 if (k == j) fC6x9jk = 1.0F; in fRun_9DOF_GBY_KALMAN()
1240 if (k == (j + 6)) fC6x9jk = -pthisSV->fAlphaOver2; in fRun_9DOF_GBY_KALMAN()
1243 if (k == j) fC6x9jk = 1.0F; in fRun_9DOF_GBY_KALMAN()
1244 if (k == (j + 3)) fC6x9jk = -pthisSV->fAlphaOver2; in fRun_9DOF_GBY_KALMAN()
1248 if ((pthisSV->fQw9x9[i][k] != 0.0F) && (fC6x9jk != 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()