Skip to content
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

Merged
merged 4 commits into from
Jan 23, 2025
Merged

Update EKF2 overview #3533

merged 4 commits into from
Jan 23, 2025

Conversation

bresch
Copy link
Member

@bresch bresch commented Jan 6, 2025

  • add terrain state
  • mention error-state formulation
  • mention Joseph covariance update
  • change position state to global position
  • update derivation link

@bresch bresch requested a review from hamishwillee January 6, 2025 16:02
@bresch bresch self-assigned this Jan 6, 2025
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.
Copy link
Collaborator

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

Copy link
Member Author

@bresch bresch Jan 23, 2025

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 ?

Copy link

No flaws found

bresch and others added 4 commits January 24, 2025 08:41
- add terrain state
- mention error-state formulation
- mention Joseph covariance update
- change position state to global position
@hamishwillee hamishwillee merged commit f8b3c3c into main Jan 23, 2025
1 check failed
@hamishwillee hamishwillee deleted the pr-ekf2_review branch January 23, 2025 21:42
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants