diff --git a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp index 8853a9dfd6d4f3b2a4752bf3245d94f46cd04c46..60f384e88239be0dbc8e3631f58e31c72566533e 100644 --- a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp +++ b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp @@ -57,7 +57,8 @@ void AP_AHRS_NavEKF::reset_gyro_drift(void) // update DCM AP_AHRS_DCM::reset_gyro_drift(); - // To-Do: add call to do the same on EKF + // reset the EKF gyro bias states + EKF.resetGyroBias(); } void AP_AHRS_NavEKF::update(void)