Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c644 float fC3x6ik; // element i, k of measurement matrix C in fRun_6DOF_GY_KALMAN() local
856 fC3x6ik = 0.0F; in fRun_6DOF_GY_KALMAN()
857 if (k == i) fC3x6ik = 1.0F; in fRun_6DOF_GY_KALMAN()
858 if (k == (i + 3)) fC3x6ik = -pthisSV->fAlphaOver2; in fRun_6DOF_GY_KALMAN()
861 if ((fC3x6ik != 0.0F) && (pthisSV->fQwCT6x3[k][j] != 0.0F)) in fRun_6DOF_GY_KALMAN()
863 if (fC3x6ik == 1.0F) in fRun_6DOF_GY_KALMAN()
866 ftmpA3x3[i][j] += fC3x6ik * pthisSV->fQwCT6x3[k][j]; in fRun_6DOF_GY_KALMAN()