Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c889 pthisSV->fK6x3[i][j] = 0.0F; in fRun_6DOF_GY_KALMAN()
895 pthisSV->fK6x3[i][j] += pthisSV->fQwCT6x3[i][k] * ftmpA3x3[k][j]; in fRun_6DOF_GY_KALMAN()
908 pthisSV->fK6x3[i][j] = 0.0F; in fRun_6DOF_GY_KALMAN()
918 if (pthisSV->fK6x3[i][CHX] != 0.0F) in fRun_6DOF_GY_KALMAN()
919 pthisSV->fqgErrPl[i] = pthisSV->fK6x3[i][CHX] * pthisSV->fZErr[CHX]; in fRun_6DOF_GY_KALMAN()
922 if (pthisSV->fK6x3[i][CHY] != 0.0F) in fRun_6DOF_GY_KALMAN()
923 pthisSV->fqgErrPl[i] += pthisSV->fK6x3[i][CHY] * pthisSV->fZErr[CHY]; in fRun_6DOF_GY_KALMAN()
924 if (pthisSV->fK6x3[i][CHZ] != 0.0F) in fRun_6DOF_GY_KALMAN()
925 pthisSV->fqgErrPl[i] += pthisSV->fK6x3[i][CHZ] * pthisSV->fZErr[CHZ]; in fRun_6DOF_GY_KALMAN()
928 if (pthisSV->fK6x3[i + 3][CHX] != 0.0F) in fRun_6DOF_GY_KALMAN()
[all …]
Dsensor_fusion.h373 float fK6x3[6][3]; ///< kalman filter gain matrix K member