Attitude dynamics aiding for three-dimensional passive target tracking of strap-down seeker based on instrumental variable Kalman filter

The accuracy of three-dimensional (3D) passive target tracking under strap-down system is usually affected by the measurement accuracy of attitude angular rate and attitude angle. In order to save the problem, a novel 3D passive target tracking method based on instrumental variable Kalman filter (IVKF) aided by the attitude dynamic is proposed. At first, the maneuvering target motion model is established based on the “current” statistical model and the filtering equation of MEMS inertial measurement unit (IMU) is also set up. Then, linearize the nonlinear state equations and replace the nonlinear measurement equations with pseudolinear equations. The 3D pseudolinear Kalman filter (PLKF) algorithm is derived according to the linear Kalman filter (KF). To counter the severe bias problems with PLKF, bias compensation and recursive instrumental variable (IV) methods are considered. In order to enhance observability of the system, a 3D motion tracking sliding-mode guidance law is deduced. Finally, some mathematical simulations were made to verify the effectiveness of the proposed method. The simulation results show the effect of the measurement accuracy and complexity of the algorithm are reduced, which proves the validity of the method.