Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c819 pthisSV->fQwCT6x3[i][j] = 0.0F; in fRun_6DOF_GY_KALMAN()
833 pthisSV->fQwCT6x3[i][j] += pthisSV->fQw6x6[i][k]; in fRun_6DOF_GY_KALMAN()
835 pthisSV->fQwCT6x3[i][j] += pthisSV->fQw6x6[i][k] * fC3x6jk; in fRun_6DOF_GY_KALMAN()
861 if ((fC3x6ik != 0.0F) && (pthisSV->fQwCT6x3[k][j] != 0.0F)) in fRun_6DOF_GY_KALMAN()
864 ftmpA3x3[i][j] += pthisSV->fQwCT6x3[k][j]; in fRun_6DOF_GY_KALMAN()
866 ftmpA3x3[i][j] += fC3x6ik * pthisSV->fQwCT6x3[k][j]; in fRun_6DOF_GY_KALMAN()
892 if ((pthisSV->fQwCT6x3[i][k] != 0.0F) && in fRun_6DOF_GY_KALMAN()
895 pthisSV->fK6x3[i][j] += pthisSV->fQwCT6x3[i][k] * ftmpA3x3[k][j]; in fRun_6DOF_GY_KALMAN()
Dsensor_fusion.h374 float fQwCT6x3[6][3]; ///< Qw.C^T matrix member