ekf2: EV vel (body) update last fuse timestamps

- these are set by the NED fuseVelocity() helper so also need to be set in the body frame velocity case
This commit is contained in:
Daniel Agar
2024-07-09 10:16:12 -04:00
committed by GitHub
parent 5d08b97fd7
commit 62ff39a669
@@ -292,6 +292,11 @@ bool Ekf::fuseEvVelocity(estimator_aid_source3d_s &aid_src, const extVisionSampl
}
if (aid_src.fused) {
_time_last_hor_vel_fuse = _time_delayed_us;
_time_last_ver_vel_fuse = _time_delayed_us;
}
aid_src.timestamp_sample = current_aid_src.timestamp_sample;
return !aid_src.innovation_rejected;