-
Notifications
You must be signed in to change notification settings - Fork 13.7k
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
EKF2: range measurement rejection in rain/fog #23579
Conversation
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
I generally like the concept, but I think that the check should have its own class. It shares absolutely nothing with the kinematic consistency check (except _time_last_update_us
) and make that class just less readable (e.g.: the setParams
is for both but the update update
function is for the kinematic check only).
src/modules/ekf2/EKF/aid_sources/range_finder/range_finder_consistency_check.hpp
Outdated
Show resolved
Hide resolved
09311d4
to
2ceafe6
Compare
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Please also cover the logic with some unit tests. Show that:
- it doesn't trigger in normal operation
- it triggers when the conditions are met
- the fault clears when back to normal
src/modules/ekf2/EKF/aid_sources/range_finder/sensor_range_finder.hpp
Outdated
Show resolved
Hide resolved
2ceafe6
to
a5f7d95
Compare
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
I think it looks good now. In the future it would be nice to add some logging of the internal values at some point as it might get difficult to see which of the range finder checks are failing and why.
When there's rain or fog the range sensor can provide wrong distance measurements. The goal was to create somewhat of a sanity check for the distance sensor while moving horizontally. Currently we only have the kin-consistency check without horizontal movement.
The current implementation is dependent on a new param and the magic hardcoded factor 2.