diff --git a/EKF/range_finder_checks.cpp b/EKF/range_finder_checks.cpp index 90304e6df51..0430da3a563 100644 --- a/EKF/range_finder_checks.cpp +++ b/EKF/range_finder_checks.cpp @@ -90,6 +90,8 @@ void Ekf::updateRangeDataValidity() } else if (_time_bad_rng_signal_quality > 0 && _imu_sample_delayed.time_us - _time_bad_rng_signal_quality > RNG_BAD_SIG_HYST) { _time_bad_rng_signal_quality = 0; _rng_hgt_valid = true; + } else if (_time_bad_rng_signal_quality == 0) { + _rng_hgt_valid = true; } // Check if excessively tilted