Correction adaptive square-root cubature Kalman filter with application to autonomous vehicle target tracking
- 7 May 2021
- journal article
- research article
- Published by IOP Publishing in Measurement Science and Technology
- Vol. 32 (11), 115101
- https://doi.org/10.1088/1361-6501/abfef4
Abstract
For a state estimation problem of nonlinear system, the square-root cubature Kalman filter (SCKF) is an effective method when the noise statistical characteristics are known. However, the performance of SCKF often degrade significantly in the face of uncertain noises interference, particularly in case of measurement or system failure. In this paper, we focus on improving the accuracy and robustness of SCKF under irregular noise. First, a weighted adaptive SCKF (WASCKF) algorithm is presented with moving window method. The WASCKF can improve the accuracy of SCKF by adaptively adjusting the covariances of measurement noise and process noise. Next, in order to further improve the robustness of WASCKF against the abrupt abnormal noise, a correction adaptive SCKF (CASCKF) algorithm based on fault detection mechanism is proposed. The CASCKF algorithm can detect whether there is a fault according to a statistical function of Chi-square distribution, and can judge and carry out the necessary correction processing by using an isolate rule. Finally, the performance of CASCKF is verified by numerical experiments of autonomous vehicle target tracking problem. The results show that the proposed CASCKF algorithm has good accuracy and robustness even with sudden abnormal noise interference.Keywords
Funding Information
- Graduate Sicentific Research and Innovation Foundation of Chongqing, China (CYB19063)
- National Natural Science Foundation of China (51875061)
- Technology Innovation and Application Development Project of Chongqing (cstc2019jscx-zdztzxx0032)
This publication has 63 references indexed in Scilit:
- Robust Adaptive Kalman Filter for estimation of UAV dynamics in the presence of sensor/actuator faultsAerospace Science and Technology, 2013
- Fault detection and isolation in stochastic non-linear state-space models using particle filtersControl Engineering Practice, 2012
- Pico satellite attitude estimation via Robust Unscented Kalman Filter in the presence of measurement faultsISA Transactions, 2010
- INS/GPS Tightly-coupled Integration using Adaptive Unscented Particle FilterJournal of Navigation, 2010
- Particle filters for state and parameter estimation in batch processesJournal of Process Control, 2005
- Sensor and control surface/actuator failure detection and isolation applied to F‐16 flight dynamicAircraft Engineering and Aerospace Technology, 2005
- A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian trackingIEEE Transactions on Signal Processing, 2002
- A new method for the nonlinear transformation of means and covariances in filters and estimatorsIEEE Transactions on Automatic Control, 2000
- An EKF-Based Nonlinear Observer with a Prescribed Degree of StabilityAutomatica, 1998
- A New Approach to Linear Filtering and Prediction ProblemsJournal of Basic Engineering, 1960