Browse Source

removed if statement that would prevent the update of the _rng_hgt_faulty flag (#480)

master
dakejahl 7 years ago committed by Lorenz Meier
parent
commit
80146273ba
  1. 2
      EKF/control.cpp

2
EKF/control.cpp

@ -110,7 +110,6 @@ void Ekf::controlFusionModes() @@ -110,7 +110,6 @@ void Ekf::controlFusionModes()
// Get range data from buffer and check validity
_range_data_ready = _range_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_range_sample_delayed);
if (_range_data_ready) {
checkRangeDataValidity();
if (_range_data_ready && !_rng_hgt_faulty) {
@ -119,7 +118,6 @@ void Ekf::controlFusionModes() @@ -119,7 +118,6 @@ void Ekf::controlFusionModes()
Vector3f pos_offset_earth = _R_to_earth * pos_offset_body;
_range_sample_delayed.rng += pos_offset_earth(2) / _R_rng_to_earth_2_2;
}
}
// We don't fuse flow data immediately because we have to wait for the mid integration point to fall behind the fusion time horizon.
// This means we stop looking for new data until the old data has been fused.

Loading…
Cancel
Save