-
Notifications
You must be signed in to change notification settings - Fork 1.8k
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
Update EKF2 overview #3533
Update EKF2 overview #3533
Conversation
bresch
commented
Jan 6, 2025
•
edited
Loading
edited
- add terrain state
- mention error-state formulation
- mention Joseph covariance update
- change position state to global position
- update derivation link
Reducing the 'fusion time horizon' delay reduces errors in the complementary filter used to propagate states forward to current time. | ||
::: | ||
|
||
The EKF uses the IMU data for state prediction only. IMU data is not used as an observation in the EKF derivation. | ||
The algebraic equations for the covariance prediction and measurement jacobians are derived using [SymForce](https://symforce.org/) and can be found here: [Symbolic Derivation](https://github.com/PX4/PX4-Autopilot/blob/main/src/modules/ekf2/EKF/python/ekf_derivation/derivation.py). | ||
Covariance update is done using the Joseph Stabilized form to improve numerical stability and allow conditional update of independent states. |
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.
Would a link be helpful or will all readers know what this is or be able to search? https://en.wikipedia.org/wiki/Kalman_filter#Deriving_the_posteriori_estimate_covariance_matrix
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.
Yes, good idea, we could link that wikipedia section. Like this: https://github.com/PX4/PX4-user_guide/pull/3533/files#r1926992602 ?
No flaws found |
- add terrain state - mention error-state formulation - mention Joseph covariance update - change position state to global position
Co-authored-by: Mathieu Bresciani <[email protected]>
e05e6f6
to
1286b2b
Compare