|
|
@ -365,9 +365,8 @@ bool Ekf::update() |
|
|
|
_fuse_flow = false; |
|
|
|
_fuse_flow = false; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// TODO This is just to get the logic inside but we will only start fusion once we tested this again
|
|
|
|
// If we are using airspeed measurements and data has fallen behind the fusion time horizon then fuse it
|
|
|
|
//if (_airspeed_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_airspeed_sample_delayed)) {
|
|
|
|
if (_airspeed_buffer.pop_first_older_than(_imu_sample_delayed.time_us, &_airspeed_sample_delayed)) { |
|
|
|
if (false) { |
|
|
|
|
|
|
|
fuseAirspeed(); |
|
|
|
fuseAirspeed(); |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|