Add option to make EKF3 more robust to bad IMU and lagged GPS data #24135
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
This provides an alternative to #23030.
Setting EK3_GLITCH_RAD will prevent the EKF from rejecting GPS position and velocity measurements if innovation checks fail. Instead the innovation variance is increased to a value that just passes the measurement which de-weights the measurement but still allows it to be used, ensuring that the EKF always provides a position and velocity estimate.
This has been tested on replay of a log provided from an ArduCopter AUTO mission with 3.5g manoeuvre peaks.
Commit 219fd3e has been extensively flight tested by @andyp1per , however commit 8e120d8 has only been replay tested.
We need flight testing in setups that can exceed the 4g GPS manoeuvre limit.