ekf2: fusion helpers return success/fail and set pos/vel update timestamps centrally (if healthy)

This commit is contained in:
Daniel Agar
2022-02-22 17:33:21 -05:00
parent c4bc062714
commit c10ea97967
6 changed files with 105 additions and 64 deletions
-1
View File
@@ -1065,7 +1065,6 @@ void Ekf::controlAuxVelFusion()
bool Ekf::hasHorizontalAidingTimedOut() const
{
return isTimedOut(_time_last_hor_pos_fuse, _params.reset_timeout_max)
&& isTimedOut(_time_last_delpos_fuse, _params.reset_timeout_max)
&& isTimedOut(_time_last_hor_vel_fuse, _params.reset_timeout_max)
&& isTimedOut(_time_last_of_fuse, _params.reset_timeout_max);
}