Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c755 pthisSV->fZErr[CHX] = ftmpq.q1; in fRun_6DOF_GY_KALMAN()
756 pthisSV->fZErr[CHY] = ftmpq.q2; in fRun_6DOF_GY_KALMAN()
757 pthisSV->fZErr[CHZ] = ftmpq.q3; in fRun_6DOF_GY_KALMAN()
919 pthisSV->fqgErrPl[i] = pthisSV->fK6x3[i][CHX] * pthisSV->fZErr[CHX]; in fRun_6DOF_GY_KALMAN()
923 pthisSV->fqgErrPl[i] += pthisSV->fK6x3[i][CHY] * pthisSV->fZErr[CHY]; in fRun_6DOF_GY_KALMAN()
925 pthisSV->fqgErrPl[i] += pthisSV->fK6x3[i][CHZ] * pthisSV->fZErr[CHZ]; in fRun_6DOF_GY_KALMAN()
929 pthisSV->fbErrPl[i] = pthisSV->fK6x3[i + 3][CHX] * pthisSV->fZErr[CHX]; in fRun_6DOF_GY_KALMAN()
933 pthisSV->fbErrPl[i] += pthisSV->fK6x3[i + 3][CHY] * pthisSV->fZErr[CHY]; in fRun_6DOF_GY_KALMAN()
935 pthisSV->fbErrPl[i] += pthisSV->fK6x3[i + 3][CHZ] * pthisSV->fZErr[CHZ]; in fRun_6DOF_GY_KALMAN()
1151 pthisSV->fZErr[0] = ftmpq.q1; in fRun_9DOF_GBY_KALMAN()
[all …]
Dsensor_fusion.h376 float fZErr[3]; ///< measurement error vector member
409 float fZErr[6]; ///< measurement error vector member
Doutput_stream.c718 … if (six_axis_kalman) scratch16 = (int16_t) (sfg->SV_6DOF_GY_KALMAN.fZErr[i] * 30000.0F); in CreateAndSendPackets()
721 … if (nine_axis_kalman) scratch16 = (int16_t) (sfg->SV_9DOF_GBY_KALMAN.fZErr[i] * 30000.0F); in CreateAndSendPackets()
749 … if (nine_axis_kalman) scratch16 = (int16_t) (sfg->SV_9DOF_GBY_KALMAN.fZErr[i + 3] * 30000.0F); in CreateAndSendPackets()