From a9336529507431ea14cb1308c920578eafefc16d Mon Sep 17 00:00:00 2001 From: Peter Barker Date: Tue, 24 Aug 2021 13:01:16 +1000 Subject: [PATCH] AP_AHRS: return perfect airspeed estimate for EKF-type 10 ... rather than the EKF3 estimate --- libraries/AP_AHRS/AP_AHRS.cpp | 13 ++++--------- 1 file changed, 4 insertions(+), 9 deletions(-) diff --git a/libraries/AP_AHRS/AP_AHRS.cpp b/libraries/AP_AHRS/AP_AHRS.cpp index 0c48a52079..263041fa25 100644 --- a/libraries/AP_AHRS/AP_AHRS.cpp +++ b/libraries/AP_AHRS/AP_AHRS.cpp @@ -822,16 +822,11 @@ bool AP_AHRS::airspeed_estimate(float &airspeed_ret) const #if CONFIG_HAL_BOARD == HAL_BOARD_SITL case EKFType::SIM: -#if HAL_NAVEKF3_AVAILABLE - if (EKF3.getWind(-1,wind_vel)) { - ret = true; - } else { - ret = false; + if (!_sitl) { + return false; } -#else - ret = false; -#endif - break; + airspeed_ret = _sitl->state.airspeed; + return true; #endif #if HAL_NAVEKF2_AVAILABLE