Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c645 float fC3x6jk; // element j, k of measurement matrix C in fRun_6DOF_GY_KALMAN() local
825 fC3x6jk = 0.0F; in fRun_6DOF_GY_KALMAN()
826 if (k == j) fC3x6jk = 1.0F; in fRun_6DOF_GY_KALMAN()
827 if (k == (j + 3)) fC3x6jk = -pthisSV->fAlphaOver2; in fRun_6DOF_GY_KALMAN()
830 if ((pthisSV->fQw6x6[i][k] != 0.0F) && (fC3x6jk != 0.0F)) in fRun_6DOF_GY_KALMAN()
832 if (fC3x6jk == 1.0F) in fRun_6DOF_GY_KALMAN()
835 pthisSV->fQwCT6x3[i][j] += pthisSV->fQw6x6[i][k] * fC3x6jk; in fRun_6DOF_GY_KALMAN()