估计弹目视线角速率的快收敛Kalman滤波器的设计方法

摘要

估计弹目视线角速率的快收敛Kalman滤波器的设计方法，属于导弹制导控制技术领域。本发明为了提高现有的目标—导弹视线角速度估计Kalman滤波方法的收敛速度。首先设置滤波器初始估计值；然后测算当前时刻目标与导弹之间的相对距离和相对速度；测算导弹加速度在视线坐标系o′y₄和o′z₄轴方向上的分量；最后由导弹俯仰通道视线运动状态方程和俯仰通道视线角测量方程构造俯仰通道快收敛Kalman滤波器，由导弹偏航通道视线运动状态方程和偏航通道视线角测量方程构造偏航通道快收敛Kalman滤波器，从而分别求出目标与导弹之间的视线俯仰角速率和视线偏航角速率。本发明提高Kalman滤波器的收敛速度，得到高精度的视线角速率估计。