Home
last modified time | relevance | path

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

/hal_nxp-3.6.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c764 for (j = 0; j < 6; j++) pthisSV->fQw6x6[i][j] = 0.0F; in fRun_6DOF_GY_KALMAN()
767 pthisSV->fQw6x6[3][3] = pthisSV->fbErrPl[CHX] * pthisSV->fbErrPl[CHX]; in fRun_6DOF_GY_KALMAN()
768 pthisSV->fQw6x6[4][4] = pthisSV->fbErrPl[CHY] * pthisSV->fbErrPl[CHY]; in fRun_6DOF_GY_KALMAN()
769 pthisSV->fQw6x6[5][5] = pthisSV->fbErrPl[CHZ] * pthisSV->fbErrPl[CHZ]; in fRun_6DOF_GY_KALMAN()
772 pthisSV->fQw6x6[0][0] = pthisSV->fqgErrPl[CHX] * in fRun_6DOF_GY_KALMAN()
776 pthisSV->fQw6x6[3][3]; in fRun_6DOF_GY_KALMAN()
777 pthisSV->fQw6x6[1][1] = pthisSV->fqgErrPl[CHY] * in fRun_6DOF_GY_KALMAN()
781 pthisSV->fQw6x6[4][4]; in fRun_6DOF_GY_KALMAN()
782 pthisSV->fQw6x6[2][2] = pthisSV->fqgErrPl[CHZ] * in fRun_6DOF_GY_KALMAN()
786 pthisSV->fQw6x6[5][5]; in fRun_6DOF_GY_KALMAN()
[all …]
Dsensor_fusion.h372 float fQw6x6[6][6]; ///< covariance matrix Qw member