Searched refs:fbErrPl (Results 1 – 2 of 2) sorted by relevance
302 pthisSV->fbErrPl[i] = 0.0F; in fInit_6DOF_GY_KALMAN()367 pthisSV->fbErrPl[i] = 0.0F; in fInit_9DOF_GBY_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()795 pthisSV->fbErrPl[CHX] - in fRun_6DOF_GY_KALMAN()799 pthisSV->fbErrPl[CHY] - in fRun_6DOF_GY_KALMAN()803 pthisSV->fbErrPl[CHZ] - in fRun_6DOF_GY_KALMAN()929 pthisSV->fbErrPl[i] = pthisSV->fK6x3[i + 3][CHX] * pthisSV->fZErr[CHX]; in fRun_6DOF_GY_KALMAN()931 pthisSV->fbErrPl[i] = 0.0F; in fRun_6DOF_GY_KALMAN()[all …]
379 float fbErrPl[3]; ///< gyro offset error (deg/s) member417 float fbErrPl[3]; ///< gyro offset error (deg/s) member
