Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dfusion.c296 pthisSV->fMaxGyroOffsetChange = sqrtf(fabs(FQWB_6DOF_GY_KALMAN)) / (float)FUSION_HZ; in fInit_6DOF_GY_KALMAN()
361 pthisSV->fMaxGyroOffsetChange = sqrtf(fabs(FQWB_9DOF_GBY_KALMAN)) / (float)FUSION_HZ; in fInit_9DOF_GBY_KALMAN()
972 if (pthisSV->fbErrPl[i] > pthisSV->fMaxGyroOffsetChange) in fRun_6DOF_GY_KALMAN()
973 pthisSV->fbPl[i] -= pthisSV->fMaxGyroOffsetChange; in fRun_6DOF_GY_KALMAN()
974 else if (pthisSV->fbErrPl[i] < -pthisSV->fMaxGyroOffsetChange) in fRun_6DOF_GY_KALMAN()
975 pthisSV->fbPl[i] += pthisSV->fMaxGyroOffsetChange; in fRun_6DOF_GY_KALMAN()
1376 if (pthisSV->fbErrPl[i] > pthisSV->fMaxGyroOffsetChange) in fRun_9DOF_GBY_KALMAN()
1377 pthisSV->fbPl[i] -= pthisSV->fMaxGyroOffsetChange; in fRun_9DOF_GBY_KALMAN()
1378 else if (pthisSV->fbErrPl[i] < -pthisSV->fMaxGyroOffsetChange) in fRun_9DOF_GBY_KALMAN()
1379 pthisSV->fbPl[i] += pthisSV->fMaxGyroOffsetChange; in fRun_9DOF_GBY_KALMAN()
Dsensor_fusion.h387 float fMaxGyroOffsetChange; ///< maximum permissible gyro offset change per iteration (deg/s) member
428 float fMaxGyroOffsetChange; ///< maximum permissible gyro offset change per iteration (deg/s) member