Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c1299 pthisSV->fK9x6[i][j] = 0.0F; in fRun_9DOF_GBY_KALMAN()
1302 pthisSV->fK9x6[i][j] += pthisSV->fQwCT9x6[i][k] * ftmpA6x6[k][j]; in fRun_9DOF_GBY_KALMAN()
1309 pthisSV->fK9x6[i][j] = 0.0F; in fRun_9DOF_GBY_KALMAN()
1318 if (pthisSV->fK9x6[i][j] != 0.0F) in fRun_9DOF_GBY_KALMAN()
1319 pthisSV->fqgErrPl[i] += pthisSV->fK9x6[i][j] * pthisSV->fZErr[j]; in fRun_9DOF_GBY_KALMAN()
1322 if (pthisSV->fK9x6[i + 3][j] != 0.0F) in fRun_9DOF_GBY_KALMAN()
1323 pthisSV->fqmErrPl[i] += pthisSV->fK9x6[i + 3][j] * pthisSV->fZErr[j]; in fRun_9DOF_GBY_KALMAN()
1326 if (pthisSV->fK9x6[i + 6][j] != 0.0F) in fRun_9DOF_GBY_KALMAN()
1327 pthisSV->fbErrPl[i] += pthisSV->fK9x6[i + 6][j] * pthisSV->fZErr[j]; in fRun_9DOF_GBY_KALMAN()
Dsensor_fusion.h407 float fK9x6[9][6]; ///< kalman filter gain matrix K member