ekf2: accumulate multiple vel/pos/orientation reset deltas per update

- if in a single EKF update there are multiple resets we need to track the accumulated delta so the change consumed by the controllers is correct
This commit is contained in:
Daniel Agar
2022-11-15 13:20:54 -05:00
committed by GitHub
parent 2e918eba00
commit da82757bf6
4 changed files with 95 additions and 46 deletions
+1
View File
@@ -47,6 +47,7 @@ void Ekf::controlFusionModes()
{
// Store the status to enable change detection
_control_status_prev.value = _control_status.value;
_state_reset_count_prev = _state_reset_status.reset_count;
if (_system_flag_buffer) {
systemFlagUpdate system_flags_delayed;