捷联导引头视线角速率估计算法

An Algorithm for Estimating Line-of-Sight Angular Rate of Strapdown Seeker

研究了一种用于估计制导弹药与目标之间的视线角速率算法的推导与实现。低成本的捷联导引头的测量信息中包含了弹目在相对运动中形成的视线角和弹体姿态两部分信息,首先设计解耦算法将弹体姿态信息去除,然后采用扩展卡尔曼滤波(EKF)以及α-β滤波这两种算法分别对视线角和视线角速率进行估计,最终的仿真结果表明采用EKF算法能比α-β滤波算法得到更加精确的估计值。

This paper studies the derivation and implementation of an algorithm for estimating the angular rate of Line of Sight(LOS)angle between guided munitions and targets.The measurement information of a low-cost strapdown seeker includes two partsnamelyattitude of the missile and LOS anglewhich are formed in relative motion between the missile and the target.Firstlya decoupling algorithm is designed to remove the attitude information of the missile.ThenExtended Kalman Filter(EKF)andα-βfilter are used to estimate LOS angle and angular rate respectively.The final simulation results show that EKF can obtain a more accurate estimated value thanα-βfilter.