Skip to content

Commit

Permalink
estimatorChecks: disable warning for imminent position failure if tha…
Browse files Browse the repository at this point in the history
…t is disabled

COM_POS_FS_EPH can be set to -1, in which case the actual failure eph is INFINITY.

Signed-off-by: Silvan Fuhrer <[email protected]>
  • Loading branch information
sfuhrer committed Aug 16, 2024
1 parent f7e6e13 commit 846d424
Showing 1 changed file with 1 addition and 1 deletion.
Original file line number Diff line number Diff line change
Expand Up @@ -727,7 +727,7 @@ void EstimatorChecks::setModeRequirementFlags(const Context &context, bool pre_f
_last_gpos_fail_time_us, !failsafe_flags.global_position_invalid);

// Additional warning if the system is about to enter position-loss failsafe after dead-reckoning period
const float eph_critical = 2.5f * _param_com_pos_fs_eph.get(); // threshold used to trigger the navigation failsafe
const float eph_critical = 2.5f * lpos_eph_threshold; // threshold used to trigger the navigation failsafe
const float gpos_critical_warning_thrld = math::max(0.9f * eph_critical, math::max(eph_critical - 10.f, 0.f));

estimator_status_flags_s estimator_status_flags;
Expand Down

0 comments on commit 846d424

Please sign in to comment.