diff --git a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp index 9647d30d5898b0d1cac2712a3710480583de2e66..cb19b212b3a8bfff85b042d8d1c531cb7220b801 100644 --- a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp +++ b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp @@ -122,7 +122,9 @@ float AP_AHRS_NavEKF::get_error_yaw(void) // return a wind estimation vector, in m/s Vector3f AP_AHRS_NavEKF::wind_estimate(void) { - if (!using_EKF()) { + if (!using_EKF() || !_airspeed || !_airspeed->use()) { + // EKF does not estimate wind speed when there is no airspeed + // sensor active return AP_AHRS_DCM::wind_estimate(); } Vector3f wind;