ekf2: move airspeed buffer pop to controlAirDataFusion

This commit is contained in:
Daniel Agar
2023-02-22 09:08:33 -05:00
parent 0711a34d0e
commit 241cee2bb7
3 changed files with 7 additions and 7 deletions
+5 -1
View File
@@ -49,7 +49,7 @@
#include <mathlib/mathlib.h>
void Ekf::controlAirDataFusion()
void Ekf::controlAirDataFusion(const imuSample &imu_delayed)
{
// control activation and initialisation/reset of wind states required for airspeed fusion
@@ -66,6 +66,10 @@ void Ekf::controlAirDataFusion()
return;
}
if (_airspeed_buffer) {
_tas_data_ready = _airspeed_buffer->pop_first_older_than(imu_delayed.time_us, &_airspeed_sample_delayed);
}
if (_tas_data_ready) {
updateAirspeed(_airspeed_sample_delayed, _aid_src_airspeed);