[发明专利]一种运载火箭姿态角速率信号的测量系统及方法

说明书

技术领域

本发明涉及运载火箭冗余控制系统技术领域，特别涉及一种运载火箭姿态角速率信号的测量系统及方法。

背景技术

图1是现有运载火箭俯仰通道姿态控制系统框图。如图1所示的现有姿态控制系统中，包含设有2套捷联惯组和速率陀螺仪的惯性测量系统，箭机，伺服机构。在火箭的飞行过程中，由惯性测量系统实时测量火箭的姿态角和姿态角速度信号，其中姿态角信号由捷联惯组测得，姿态角速度信号由速率陀螺测得。箭机采样测量信息，经校正网络差分方程综合运算得到相应的控制指令，控制伺服机构作相应的运动，带动发动机摆动一定的角度，从而产生相应的控制力矩，达到姿态控制的目的。

在现有的姿态控制系统中利用速率陀螺作为姿态角速度的测量元件比用校正网络提供相位超前作用要灵活得多，它不仅通过改变速率陀螺的安装位置解决弹性振动稳定问题，还可以提高姿态控制系统抗交变干扰的能力，减轻了校正网络设计上的困难。

然而，随着科学技术的发展和国家建设的需要，“小而简单”运载火箭向着“大而复杂”的方向发展，对运载火箭的可靠性要求越来越高。为满足适应恶劣的工作环境和高可靠性要求，宜采用必要的冗余技术。由于姿态角速率测量的准确与否直接关系到运载火箭姿态控制的成败，进而影响到运载火箭飞行成败，而速率陀螺冗余会受到安装位置、运载能力等的限制。

发明内容

本发明要解决的技术问题是在现有运载火箭控制系统配置的前提下的速率信号测量冗余设计问题。

为解决上述技术问题，本发明提出一种运载火箭姿态角速率信号的测量系统及方法，在姿态控制系统的现有技术中取消速率陀螺仪，采用两套捷联惯组经诊断输出的角速率信息，经高频滤波后，作为运载火箭姿态角速率通道的测量值，实现运载火箭飞行过程中控制系统速率陀螺冗余，提高系统可靠性。

为了达到上述目的，本发明的一个技术方案是提供一种运载火箭姿态角速率的测量系统，其中对于运载火箭的俯仰通道、偏航通道和滚动通道中的每个通道，设置有伺服机构、箭机及两套捷联惯组；

每套所述捷联惯组从运载火箭的箭体处，获取姿态角信号并取代速率陀螺仪来获取角速率信号；

所述箭机中，通过冗余判别模块对两套所述捷联惯组获取的数据进行故障诊断，并将其中被诊断为正确的一套捷联惯组获取的数据作为所选捷联数据输出；通过捷联数据处理模块，将所选捷联数据中的姿态角信号和角速率信号分开形成两路信号，将其中的姿态角信号送至四元数解算模块进行运算，将其中的角速率信号送至滤波网络模块进行运算；通过设置校正网络模块对四元数解算模块及滤波网络模块的运算结果进行综合计算得到相应的控制指令，并输出该控制指令至伺服机构来实现姿态控制。

本发明的另一个技术方案是提供一种运载火箭姿态角速率的测量方法，其中对于运载火箭的俯仰通道、偏航通道和滚动通道中的每个通道，包含：

A、通过捷联惯组获取一路姿态角信号和一路角速率信号；

B、对姿态角信号进行四元数解算；对角速率信号进行滤波；

C、对四元数解算结果和角速率信号滤波结果，进行校正网络差分方程计算得到摆角控制指令，并输出至伺服机构进行姿态控制。

优选地，配置有两套捷联惯组，各自能够获取一路姿态角信号和一路角速率信号；

对两套所述捷联惯组获取的数据进行故障诊断，并将其中被诊断为正确的一套捷联惯组获取的数据作为所选捷联数据输出；

则步骤B中，是对从所选捷联数据中分出的姿态角信号和角速率信号分别进行运算。

与现有技术相比，本发明的运载火箭姿态角速率信号直接采用捷联惯组冗余后的角速率信号，其优点和有益效果是：

1)直接采用捷联惯组冗余后的角速率信号，充分利用了捷联惯组的角速率信息，在提高运载火箭可靠性的同时并没有增加硬件成本以及软件算法的复杂度。

2)针对捷联惯组冗余后的角速率信号，采用了高阶的数字滤波器进行高频滤波，该滤波器的特点是高频衰减效果好,有效的滤除了箭体设计时不需要关心的频率，避免了因捷联惯组和箭体的随机振动所引入的高频干扰信号。

3)捷联惯组与速率陀螺仪安装位置比较接近时，惯组陀螺起到了与速率陀螺仪相同的作用，控制效果良好。

附图说明

图1是现有运载火箭俯仰通道姿态控制系统框图；

图2是本发明俯仰通道姿态控制系统框图。

具体实施方式