mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-24 01:31:46 +00:00
95ae23b0e7
The Joseph form of the error covariance update equation is more numerically stable when the Kalman gain isn't optimal. Numerical instability and filter divergence can occur if the user goes long time periods between updates and the error covariance becomes ill-conditioned (the ratio between the largest and smallest eigenvalue gets too large).