Debiased Converted Measurements Kalman Filter Algorithm for Motion Parameter Estimation

Abstract

The directional warhead of ATBM missile requires accurate initiation delay time and the initiating direction to obey effective damage for TBM, which needs to estimate the relative motion parameters to improve the accuracy. A debiased converted measurement Kalman Filter is presented and used for the estimation of TBMs position in body coordinate system of ATBM missile and the relative velocity. Results of simulation shows that this algorithm has high estimation precision for the parameters and satisfies the need of building initiating control algorithm for The directional warhead of ATBM missile.