Levenberg-Marquardt Method Based Iterative Square Root Cubature Kalman Filter and its Applications to Maneuvering Re-entry Target Tracking

摘要

Levenberg-Marquardt (abbr.L-M) method based iterative square root cubature Kalman filter (abbr. ISRCKFLM) inherits the numerical stability of square root Cubature Kalman filter and effectively suppresses the influence of the larger initial estimation error and the nonlinearity of the measurement equation on the state estimation in the nonlinear state estimation due to obtaining the optimal state and variance estimates using the latest measurement through L-M method. We apply the ISRCKFLM algorithm to the state estimation of maneuvering re-entry target tracking, the simulation results demonstrate that the ISRCKFLM algorithm has better accuracy of state estimation, comparable to Unscented Kalman filter and square root Cubature Kalman filter, according to estimation error analysis of the position, velocity, drag coefficient, turn coefficient and climbing force coefficient, and has fast convergence rate.