Controlling the Kalman Update: A Covariance Constrained Approach

Authors:
Publisher website
Google Scholar
Abstract
This manuscript introduces the covariance-constrained Kalman filter (CKF), designed to enhance the performance of the traditional Kalman filter (KF) and extended Kalman filter (EKF). The EKF, particularly when applied to highly nonlinear systems, can suffer from significant issues. Large covariance updates may cause rapid convergence, which in turn leads to overconfidence in state estimates. Additionally, large state updates degrade the accuracy of the first-order Taylor series approximation, resulting in linear error covariances that poorly represent the true estimation errors. To mitigate these scenarios, the CKF constrains the Kalman gain to limit the size of both state and covariance updates, preventing overconfidence in the filter's state estimates and improving overall filter stability. The derivation of the CKF, applicable to both linear and nonlinear systems, employs Lagrange multipliers to enforce these constraints analytically. The performance of the covariance-constrained EKF (CEKF) is benchmarked against the standard EKF and partial-update EKF (PEKF) through two numerical simulations: a falling-body tracking problem and an orbit determination problem. Monte Carlo analyses reveal that the CEKF successfully reduces the number of diverging cases, enhances covariance accuracy, and matches the Mahalanobis distance to the expected performance, outperforming the EKF in the scenarios investigated. The CEKF exhibits control over both the state and covariance updates, where the PEKF is only able to control the covariance. The results confirm that the CKF is a robust and efficient alternative for filtering nonlinear systems prone to divergence due to large state and covariance updates.
Funding Information
  • Air Force Office of Scientific Research
  • Space University Research Initiative
  • Project Breaking the Launch Once Use Once Paradigm (FA9550-22-1-0093)
  • Air Force Office of Scientific Research
  • Space University Research Initiative (FA 9550-23-1-0726)
  • Naval Engineering Education Consortium
  • Project Sentient Engineering Autonomy: Learning, Intelligent, and Optimal Naval Systems (N00174-23-1-0016)
  • National Science Foundation (10.13039/100000001)
  • Industry University Collaborative Research Center
  • University: Center for Autonomous Air Mobility and Sensing (2137265)

This publication has 20 references indexed in Scilit: