[发明专利]消除全捷联导引头制导回路刻度尺系数误差的装置和方法

说明书

技术领域

本发明涉及导弹制导领域捷联导引头刻度尺系数误差的消除装置和方法，具体涉及一种消除全捷联导引头制导回路刻度尺系数误差的装置和方法。

背景技术

导引头技术是精确制导武器系统中的关键技术，导引头性能的优劣直接影响着精确制导武器的作战效果，随着探测器制造技术和成像导引头技术的逐渐发展，导引头瞬时视场已经增加到可以去掉万向支架的程度，捷联导引头及其寻的制导技术也就应运而生，捷联导引头固连在弹体上，去掉万向支架以后，捷联导引头体积小重量轻价格便宜，从国内外导弹武器系统的研究发展状况来看，捷联导引头必将成为未来导弹视线导引方法的主要形式之一。

导引头和陀螺的刻度尺系数误差是制导控制系统中的重要误差源之一，全捷联导引头在提取视线角速度的过程中，需要同时利用导引头量测的误差角信号和弹上惯导量测的弹体姿态信号，这两个传感器的刻度尺系数不一致就会引起隔离度，进而在制导回路中产生隔离度寄生回路。它不仅会影响有效导航比，还会引起制导系统潜在的不稳定性,降低制导精度。目前针对捷联导引头刻度尺系数误差的问题，目前鲜有很好的解决方法。

由于上述问题的存在，本发明人对现有的全捷联导引头制导回路进行了深入研究，以便提出解决刻度尺系数误差的方法。

发明内容

为了克服上述问题，本发明人进行了锐意研究，结果发现，通过设置一种消除全捷联导引头制导回路刻度尺系数误差的装置，该装置用于实现消除全捷联导引头制导回路刻度尺系数误差的方法，所述装置包括输入模块、滤波模块、评估模块和补偿模块，通过输入模块在过载指令信息上叠加强迫抖动信号，弹体前向通道和姿态陀螺补偿通道在经过滤波模块过滤后的信号中提取视线角速率信号弹体姿态角速率信号，通过评估模块建立状态方程和量测方程以及卡尔曼滤波方程，通过卡尔曼滤波方程评估计算刻度尺系数误差的估计值，通过补偿模块将刻度尺系数误差的估计值和弹体姿态角速率信息相乘，并将乘得的补偿信息输入至含弹体扰动的惯性系下弹目视线角速率信息中，从而完成刻度尺系数误差的补偿，从而完成本发明。

具体来说，本发明的目的在于提供以下方面：

（1）一种消除全捷联导引头制导回路刻度尺系数误差的装置，

所述全捷联导引头制导回路包括：二次积分模块，其对接收到的目标加速度信息进行二次积分处理，并输出导弹与目标位置偏差信息；数学模块，其用于接收导弹与目标位置偏差信息，并输出弹目视线角信息；微分模块，其对弹目视线角信息进行微分计算得到弹目视线角速率信息；比例导引律模块，其接收弹目视线角速率信息，并将计算得到的过载指令信息输送至驾驶仪动力学模块；驾驶仪动力学模块，其输出导弹加速度响应信息；角速率陀螺动力学模块，其根据导弹加速度响应信息测量并输出弹体角速率信息；积分模块，其接收弹体角速率信息并对接收到的信息进行积分处理，得到弹体姿态角信息；其中，通过弹体前向通道提取弹目视线角速率信息，通过姿态陀螺补偿通道提取弹体姿态角速率信息；

其特征在于，该装置包括：输入模块、滤波模块、评估模块和补偿模块，其中：

输入模块用于输出强迫抖动信号，并将该强迫抖动信号叠加在由比例导引律模块输出的过载指令信息上，所述的强迫抖动信号为固定幅值和固定频率的正弦信号，其中，幅值大于或等于弹体需用过载，频率为15rad/s以上；

滤波模块包括带通滤波器，带通滤波器设置于弹体前向通道和姿态陀螺补偿通道上，带通滤波器用于过滤进入弹体前向通道的信号和进入姿态陀螺补偿通道的信号，弹体前向通道和姿态陀螺补偿通道从经过带通滤波器过滤的信号中提取由强迫抖动信号引起的视线角速率信号和由强迫抖动信号引起的弹体姿态角速率信号；

评估模块用于接收弹体前向通道和姿态陀螺补偿通道提取出的由强迫抖动信号引起的弹目视线角速率信息和由强迫抖动信号引起的弹体姿态角速率信息，跟据接收到的信息建立状态方程和量测方程，并根据状态方程和量测方程建立卡尔曼滤波方程，通过卡尔曼滤波方程计算得到刻度尺系数误差的估计值，把刻度尺系数误差的估计值输入至补偿模块，所述状态方程如下