diff --git a/src/modules/ekf2/EKF/aid_sources/range_finder/range_height_control.cpp b/src/modules/ekf2/EKF/aid_sources/range_finder/range_height_control.cpp index 104ec47d91..93e15766ea 100644 --- a/src/modules/ekf2/EKF/aid_sources/range_finder/range_height_control.cpp +++ b/src/modules/ekf2/EKF/aid_sources/range_finder/range_height_control.cpp @@ -187,7 +187,7 @@ void Ekf::controlRangeHaglFusion() } else if (is_fusion_failing) { // Some other height source is still working - if (_hagl_sensor_status.flags.flow) { + if (_hagl_sensor_status.flags.flow && isTerrainEstimateValid()) { ECL_WARN("stopping %s fusion, fusion failing", HGT_SRC_NAME); stopRngHgtFusion(); stopRngTerrFusion();