diff --git a/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.cpp b/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.cpp index 1d425cb853..6aec6936b2 100644 --- a/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.cpp +++ b/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.cpp @@ -73,7 +73,7 @@ void AuxGlobalPosition::update(Ekf &ekf, const estimator::imuSample &imu_delayed return; } - estimator_aid_source2d_s aid_src{}; + estimator_aid_source2d_s &aid_src = _aid_src_aux_global_position; const LatLonAlt position(sample.latitude, sample.longitude, sample.altitude_amsl); const Vector2f innovation = (ekf.getLatLonAlt() - position).xy(); // altitude measurements are not used diff --git a/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.hpp b/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.hpp index e5bc78026a..423462d6ee 100644 --- a/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.hpp +++ b/src/modules/ekf2/EKF/aid_sources/aux_global_position/aux_global_position.hpp @@ -92,6 +92,7 @@ private: uint8_t lat_lon_reset_counter{}; }; + estimator_aid_source2d_s _aid_src_aux_global_position{}; RingBuffer _aux_global_position_buffer{20}; // TODO: size with _obs_buffer_length and actual publication rate uint64_t _time_last_buffer_push{0};