Searched refs:FQWB_6DOF_GY_KALMAN (Results 1 – 2 of 2) sorted by relevance
48 #define FQWB_6DOF_GY_KALMAN 2E-2F ///< gyro offset random walk units (deg/s)^2 macro
291 pthisSV->fQwbOver3 = FQWB_6DOF_GY_KALMAN / 3.0F; in fInit_6DOF_GY_KALMAN()295 …fAlphaSqQvYQwbOver12 = pthisSV->fAlphaSqOver4 * (FQVY_6DOF_GY_KALMAN + FQWB_6DOF_GY_KALMAN) / 3.0F; in fInit_6DOF_GY_KALMAN()296 pthisSV->fMaxGyroOffsetChange = sqrtf(fabs(FQWB_6DOF_GY_KALMAN)) / (float)FUSION_HZ; in fInit_6DOF_GY_KALMAN()