[发明专利]一种利用双惯组进行弹性振荡抑制的方法及系统

摘要

本发明公开了一种利用双惯组进行弹性振荡抑制的方法和系统，方法包括以下步骤S1、双惯组分别采集运载器角速率信息；S2、根据获取的运载器角速率信息获取线性加权系数K；S3、根据运载器角速率信息，进行加权系数K的线性叠加，从而获取阻断了弹性振荡后的真实弹体角速率。本发明还提供了实现上述方法的系统。本发明方法和系统利用双惯组采集的不同信息，自动选取加权系数进行线性叠加，从而输出只有微弱弹性信息的惯组数据，进而阻断了弹性振荡对姿态控制系统的不利影响。本发明方法和系统具有算法简单，易于工程实现的优点。

主权项

一种利用双惯组进行弹性振荡抑制的方法，其特征在于，所述方法包括以下步骤：S1、双惯组中第一惯组和第二惯组分别采集运载器角速率信息omg0和omg1；S2、根据采集的运载器角速率信息omg0和omg1获取线性加权系数K：K＝K0+int[C*sign(omg_in1)*omg_in2]，其中，K0＝k00/(k00‑k10)，k00为运载器发动机点火前第一惯组所处位置上的振型斜率；k10为发动机点火前第二惯组所处位置上的振型斜率；函数int(x)表示对自变量x的积分，初始值为0；函数sign(x)表示对自变量x取符号，当x为正值时，sign(x)＝1；当x为负值时，sign(x)＝‑1；C为收敛因子；omg_in1＝omg0‑omg1，omg_in2＝omg0‑K(omg0‑omg1)‑notch(omg0)；函数notch(x)为陷波滤波器，其传递函数为notch＝(S2+2*0.02*wn*S+wn2)/(S2+2*0.96*wn*S+wn2),wn为运载器的固有频率；S3、根据线性加权系数K获取阻断了弹性振荡后的真实弹体角速率omg＝omg0‑(omg0‑omg1)K。