本发明属于导弹,具体涉及一种高超声速火箭弹滤波方法。
背景技术:
1、高超声速火箭弹制导控制系统比较复杂,输入信号较多、计算量较大,导致弹载计算机解算周期往往在4ms左右。而弹体角速率信号作为参与控制解算的短周期输入信号,其信号品质对控制效果影响较大,弹载惯性装置输出的角速率信息测量周期为2ms。如何在弹载计算机4ms解算周期中利用2ms周期的角速率信息,目前常规的用法是将2ms信息用4ms周期采样后进行使用,此时使用的滤波器也是以4ms周期离散化的滤波器,这样不仅造成了信息资源的浪费,同时也使得滤波效果下降。
技术实现思路
1、为了克服现有技术的不足,本发明提供了一种高超声速火箭弹滤波方法,首先采用双线性变换法对滤波器进行离散化,然后设计滤波算法,以4ms解算周期实现了2ms的滤波效果,试验表明优化后的滤波算法效果较好。
2、本发明解决其技术问题所采用的技术方案包括如下步骤:
3、步骤1:采用双线性变换法对滤波器进行离散化;
4、滤波器的传递函数为:
5、
6、其中,为陷波中心频率;
7、采用变换关系:
8、
9、其中为离散化周期;
10、则离散化的滤波器为
11、
12、步骤2:滤波算法设计;
13、将每个解算周期得到的两帧角速率信息进行分组,分别记为前2ms角速率和后2ms角速率;
14、利用步骤1离散化后的滤波器进行滤波,如下所示:
15、
16、其中,为滤波器滤波结果,为中间变量,为上一帧的滤波结果,为上一帧的后2ms角速率,为上一帧的前2ms角速率;
17、
18、本发明的有益效果如下:
19、本发明以某高超声速火箭弹为背景,对制导控制系统设计中的滤波算法进行了研究,以4ms解算周期实现了2ms的滤波效果,试验表明优化后的滤波算法效果较好。
1.一种高超声速火箭弹滤波方法,其特征在于,包括以下步骤: