Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c366 pthisSV->fqmErrPl[i] = 0.0F; in fInit_9DOF_GBY_KALMAN()
1200 pthisSV->fQw9x9[3][3] = pthisSV->fqmErrPl[CHX] * pthisSV->fqmErrPl[CHX] + ftmpA3x1[0]; in fRun_9DOF_GBY_KALMAN()
1201 pthisSV->fQw9x9[4][4] = pthisSV->fqmErrPl[CHY] * pthisSV->fqmErrPl[CHY] + ftmpA3x1[1]; in fRun_9DOF_GBY_KALMAN()
1202 pthisSV->fQw9x9[5][5] = pthisSV->fqmErrPl[CHZ] * pthisSV->fqmErrPl[CHZ] + ftmpA3x1[2]; in fRun_9DOF_GBY_KALMAN()
1216 pthisSV->fQw9x9[3][6] = pthisSV->fqmErrPl[CHX] * pthisSV->fbErrPl[CHX] - ftmpA3x1[0]; in fRun_9DOF_GBY_KALMAN()
1217 pthisSV->fQw9x9[4][7] = pthisSV->fqmErrPl[CHY] * pthisSV->fbErrPl[CHY] - ftmpA3x1[1]; in fRun_9DOF_GBY_KALMAN()
1218 pthisSV->fQw9x9[5][8] = pthisSV->fqmErrPl[CHZ] * pthisSV->fbErrPl[CHZ] - ftmpA3x1[2]; in fRun_9DOF_GBY_KALMAN()
1315 pthisSV->fqgErrPl[i] = pthisSV->fqmErrPl[i] = pthisSV->fbErrPl[i] = 0.0F; in fRun_9DOF_GBY_KALMAN()
1323 pthisSV->fqmErrPl[i] += pthisSV->fK9x6[i + 3][j] * pthisSV->fZErr[j]; in fRun_9DOF_GBY_KALMAN()
1343 ftmpq.q1 = -pthisSV->fqmErrPl[CHX]; in fRun_9DOF_GBY_KALMAN()
[all …]
Dsensor_fusion.h415 float fqmErrPl[3]; ///< geomagnetic vector tilt orientation quaternion error (dimensionless) member
Doutput_stream.c763 … if (nine_axis_kalman) scratch16 = (int16_t) (sfg->SV_9DOF_GBY_KALMAN.fqmErrPl[i] * 30000.0F); in CreateAndSendPackets()