运载火箭单惯组多表冗余的故障诊断与重构

2021-04-02 02:13张焕鑫杨雪霖
计算机测量与控制 2021年3期
关键词:加速度计陀螺仪增量

张焕鑫,周 涛,杨雪霖

(1.宇航智能控制技术国家级重点实验室,北京 100854;2.北京航天自动控制研究所,北京 100854;3.北京航天控制仪器研究所,北京 100039)

0 引言

运载火箭大多采用冗余技术来获得高可靠的容错惯性导航系统,从硬件角度,通过提高单一惯性器件可靠性的方式来保证运载火箭惯性导航系统的高可靠性,由于受到生产工艺水平等因素限制,面临着投入大、周期长、见效慢等问题,而且可靠性提升空间有限。通过设置冗余(即超过所需数量)惯性器件或可实现惯性导航的惯导部件,采用冗余管理算法对测量信息进行故障诊断和诊断后的信息重构,达到运用冗余设计吸收故障或隔离故障的效果,以此来提高运载火箭惯性导航系统可靠性,效果显著[1-3]。

无论是配置冗余惯性器件还是配置冗余惯导部件都能够实现运载器惯性导航系统可靠性的提高。本文主要介绍一种运载火箭十表配置的单惯组冗余设计方案,采用单表级的冗余管理策略,对冗余惯测信息进行故障诊断和诊断后的惯测信息重构,即对加速度计与陀螺仪输出信息各自进行冗余故障诊断与信息重构,一度故障下能准确定位故障表,两度故障下能进行典型故障诊断,输出准确可用的导航信息,确保可靠飞行,而且能根据决策,选取合理的导航信息,尽可能减小故障对精度影响。

1 惯性测量装置的冗余技术

从冗余配置方式角度,运载器惯性导航系统的冗余方案可分为单表冗余和系统冗余[3],在捷联惯性导航系统中,对惯性测量装置中的单个惯性器件进行冗余配置,工作过程中当某些惯性器件出现故障时,惯性导航系统仍然可以通过其余惯性器件能够正常输出飞行器角速度、加速度导航信息,也即实现了单表冗余技术;系统冗余是指多个实现惯性导航的部件构成的冗余系统,当其中一个部件出现故障时,通过其余的部件可以正常输出飞行器角速度、加速度导航信息。

国内外很多航空航天运载器惯性导航系统大都采用系统冗余设计。文献[4]提到的美国“土星”V、前苏联“东方”号、“联盟”号飞船、欧空局“阿里安”V,其惯导系统都采用了系统冗余方式,或者是“惯性平台+捷联惯组”冗余,或者是“捷联惯组+捷联惯组”冗余;国内运载火箭出现最早的冗余惯性导航系统是采用惯性平台为主、挠性陀螺捷联组合为备份的系统冗余方式,在后来运载火箭研制过程中,惯性平台+捷联惯组、双捷联惯组以及3套捷联惯组等多种系统冗余方案也都得到研究及应用。

系统冗余容易消除系统内部的单点,可靠性比较高,而且软、硬件结合便于灵活控制,能够实现不同类型信息的综合利用[3]。但单表冗余除了能够明显提高局部可靠性,在系统的重量、体积和成本方面相比系统冗余更具有明显的优势。

文献[5]提出一种捷联惯组的单自由度四陀螺+四加速度表方案,三陀螺+三加速度表正交,陀螺仪和加速度表各有一表斜置,且斜置表与正交三轴夹角相同,那么任一表出现故障,通过故障诊断与信息重构,惯组都可正常工作。

文献[5]同时也提出了一种非正交配置的正十二面体捷联惯组方案,即单自由度六陀螺仪和六加速度表的测量轴分别沿正十二面体六个平面法线方向,且测量轴相对载体轴均为斜置。该方案最多可容忍任意3个陀螺或加速度表同时故障,沿载体3个轴的惯测信息仍可由其余3个仪表输出得到。

文献[5]以及文献[6]都提出了双自由度三陀螺+四加速度表的捷联惯组方案,即3个双自由度陀螺按正交配置,3个载体的角速度均由两个陀螺测量,形成双冗余;3个加速度表按正交配置,有一表斜置。这样任意一个陀螺或加速度表发生故障,仍可由其余陀螺或加速度表输出得到惯测信息。

文献[2]提出了一种4个双自由度陀螺仪和4个加速度计的半八面体配置方案。4个测量轴互不垂直,该冗余方案允许任意两个陀螺仪同时故障,允许任一加速度计故障。

文献[7]提到一种多惯性仪表(一般大于4个)互不垂直的圆锥体结构配置方案,各表沿测量轴均匀放置在一倒圆锥体的圆锥面上,其平面夹角与仪表配置数量有关,各表输入轴沿着圆锥母线方向。若配置5个陀螺仪和5个加速度计,则允许任意两个陀螺仪故障,也允许任两个加速度计故障。

多表冗余的单惯组可以有多种惯性仪表配置方案,但是当惯性仪表数量增加到一定程度后,单惯组可靠度的增加就不再是很明显,而且整个惯导系统的体积、重量和成本却因为惯性仪表数量增加的同时也相应增加。

近年来,一种十表冗余的单惯组开始在运载火箭上应用,该捷联惯组具有5个单自由度陀螺仪和5个加速度计,其中3个陀螺仪和3个加速度计正交安装,两个陀螺仪和两个加速度计斜置安装。十表冗余配置的捷联惯组具有冗余的角速度、视加速度信息,因此也就具备了故障诊断、隔离与重构的基础。故障诊断可将故障定位到具体的惯性仪表,将故障仪表测量信息进行隔离,此时,既可以利用全部冗余器件进行重构,也可以选用部分冗余器件进行重构,因此,故障适应能力明显增强,可以应对二度故障,甚至两度故障下还可以进行典型故障诊断。

2 单惯组十表冗余方案

十表冗余的单惯组配置5个单自由度陀螺仪Gx、Gy、Gz、Gs、Gt和5个加速度计Ax、Ay、Az、As、At,如图1所示,其中Gx、Gy、Gz三个陀螺仪成正交安装,分别沿惯测部件测量坐标系O-XsYsZs的OXs、OYs、OZs轴方向安装,测量轴正向为箭头所指方向;Gs斜置,沿OS轴方向安装,测量轴正向为图中箭头所指方向;Gt斜置,沿OT轴方向安装,测量轴正向为图中箭头所指方向;Ax、Ay、Az三个加速度计成正交安装,分别沿OXs、OYs、OZs轴方向安装,测量轴正向为箭头所指方向;As斜置,沿OS轴方向安装,测量轴正向为图中箭头所指方向;At斜置,沿OT轴方向安装,测量轴正向为图中箭头所指方向。5个陀螺仪Gx、Gy、Gz、Gs、Gt和5个加速度计Ax、Ay、Az、As、At分别敏感Xs、Ys、Zs、S、T坐标轴向上的角速度和视加速度信号。

图1 惯性仪表安装定向示意图

惯测部件采用整体斜置10°方式,是为了保证运载火箭在水平或竖直状态下,5个加速度计均能够敏感到足够的重力加速度分量。惯测部件测量坐标系O-XsYsZs与箭体坐标系O-X1Y1Z1(其中OX1为纵轴,OY1为法向轴,OZ1为横向轴)的关系如下:

由箭体坐标系O-X1Y1Z1至惯测部件测量坐标系O-XsYsZs的方向余弦矩阵为:

C=C1×C2=

其中:Ky=10°,Kz=10°。

3 冗余管理流程

捷联惯组的故障模式多种多样,综合来看,从故障后陀螺仪和加速度计的输出特性分析,对陀螺仪、加速度计的角速度和视加速度信息的故障诊断主要考虑常零值、极大值和一致性判别(对应惯组无输出、满量程、慢漂等故障模式)。

十表冗余的单惯组冗余管理流程如图2所示。首先对惯组陀螺仪和加速度计脉冲数据采样,接着完成陀螺仪常零值判别,再进行脉冲当量转换及误差补偿,极大值判别与角增量一致性判别后,根据角速度诊断信息进行信息重构并完成角增量计算,加速度计冗余管理流程同陀螺仪冗余管理流程类似,经过常零值判别,脉冲当量转换及误差补偿,极大值判别及角增量一致性判别后,根据故障诊断信息进行信息重构并完成视速度增量信息计算,计算得到的角增量参与四元数计算后,与视速度增量共同完成导航计算。

图2 十表冗余的单惯组冗余管理流程

4 冗余故障诊断与信息重构

4.1 陀螺仪的故障诊断

对陀螺仪的故障诊断有陀螺仪脉冲常零值输出判别、脉冲增量极大值输出判别以及角增量一致性判别。

陀螺仪冗余诊断流程如图3所示,具体如下:

图3 陀螺仪冗余诊断流程

1)判断是否发生两度故障,如果已发生两度故障,则直接转入8)导航信息选取与故障信息重构,如果没有发生两度故障,则转入2)进行极大值与常零值故障诊断与计数;

2)进行极大值与常零值故障诊断与计数,然后转入3)判断是否发生一度及以上故障;

3)判断是否发生一度及以上故障,如果已发生一度及以上故障,则转入8)导航信息选取与故障信息重构,如果没有发生两度故障,则转入4)短周期故障诊断与计数;

4)进行短周期故障诊断与计数;

5)判断是否发生一度故障,如果发生一度故障,则转入8)导航信息选取与故障信息重构,如果没有发生两度故障,则转入6)长周期故障诊断中累积量计算故障数据剔除;

6)长周期故障诊断中累积量计算故障数据剔除;

7)进行长周期故障诊断;

8)导航信息选取与故障信息重构。

对于一致性判别,通过各表相互间投影的合理性进行故障判别,角增量短周期一致性判别对应的一致性检测方程如下:

(1)

(2)

(3)

(4)

(5)

(6)

(7)

(8)

(9)

(10)

角增量一致性故障判别定位表见表1。

表1 角增量一致性故障判别定位表

另外,在两度故障下还可以对陀螺仪输出进行常零值和极大值两种典型故障诊断。

故障诊断过程中,故障门限的设计非常重要。由于捷联惯组测量信息带有测量噪声,惯导系统的故障诊断不可避免有误判或漏判的可能,因此,故障诊断门限对容错惯导系统的性能,尤其是对系统可靠性有着非常大的影响。故障门限设计不合理,就有可能发生故障误判或者故障漏判。为了防止误判,同时也防止漏判,故障门限的设计要充分考虑弹道特点、惯组器件的精度水平以及故障对入轨精度的影响等多方面因素[4,7]。

4.2 加速度计的故障诊断

对加速度计的故障诊断同样分为脉冲常零值输出判别、脉冲增量极大值输出判别,还有视速度增量一致性判别。

加速度计冗余诊断流程同图3所示的陀螺仪冗余诊断流程类似。

首先判断是否发生两度故障,如是则直接进行加速度计导航信息选取与故障信息重构,否则进行极大值、常零值判别;如果纵向加速度计脉冲是零值输出,则认为常零值故障模式成立,横、法向加速度计不作零值判断。若视加速度脉冲增量输出超过门限值,则认为脉冲增量极大值故障模式成立。在极大值与常零值判别过程中,发生一度故障则进行加速度计导航信息选取与故障信息重构,如未发生一度故障,则进入视速度增量一致性判别,视速度增量一致性判别同样分为短周期一致性和长周期一致性判别,与陀螺仪角增量一致性判别类似,不再赘述。

4.3 信息重构

选择合适的故障门限,对惯组中陀螺仪和加速度计测量信息进行常零值、极大值和一致性等故障判别,导航信息的选取与故障信息重构只针对部分两度及以下故障情况,当在诊断过程中诊断出两度以上故障时,直接采用3个正交表的信息进行导航计算,以视速度增量计算为例,即:

(11)

其中:ΔWα(α=x,y,z)表示α轴当前周期的视速度增量;Exx,Exy,Exz,Eyx,Eyy,Eyz,Ezx,Ezy,Ezz为加速度计一次项系数;δWα1(α=x,y,z)表示经过误差补偿(零次项和安装误差)后参与导航运算的箭体系α轴当前周期的视速度增量。后续不再进行冗余诊断及导航信息选取与故障信息重构。

以加速度计导航信息选取与故障信息重构为例,流程如图4所示,具体如下:

图4 加速度计导航信息选取与故障信息重构流程

1)判断是否有正交表故障,如果有,转入3)判断是否有两个正交表故障,否则转入2)选用正交表测量信息进行导航解算;

2)选用正交表测量信息按公式(11)进行导航解算;

3)判断是否有两个正交表故障,如果没有,转入5)判断是否有斜置表故障,否则转入4)选用3个正常表的信息进行信息重构;

4)选用3个正常表的信息进行信息重构,以x表和y表故障为例,按公式(12)进行重构:

(12)

其中:ΔWα(α=s,t)表示α轴当前周期的视速度增量;Esx,Esy,Esz,Etx,Ety,Etz为加速度计一次项系数;

5)判断是否有斜置表故障,如果有,转入7)选用3个正常表的信息进行信息重构,否则转入6)选用4个正常表的信息进行信息重构;

6)选用4个正常表的信息进行信息重构,以x表故障为例,按公式(13)进行重构:

(13)

7)选用3个正常表的信息进行信息重构,以x表和s表故障为例,按公式(14)进行重构:

(14)

从重构策略可以看出,主要是针对正交仪表发生故障而重构,因为从成本、体积、重量等方面因素考虑,一般选用的正交表比斜置表精度高,所以从尽可能减小故障对导航精度影响角度,仅有斜置表故障时,也直接选用正交表测量信息。

5 结束语

本文介绍了一种运载火箭单捷联惯组十表冗余的惯测信息故障诊断和信息重构技术,通过选取合理的故障阈值进行诊断,在一度故障下准确定位故障表,在两度故障下能进行典型故障诊断,对故障仪表隔离后进行信息重构,实现一度故障及部分两度故障情况下导航信息的正常输出,在工程应用中增强了运载火箭惯导系统对惯组故障的容错能力,同时也为后续运载火箭惯性测量装置冗余技术提供不同的设计思路。

猜你喜欢
加速度计陀螺仪增量
KD514:陀螺仪船桨空间姿态捕捉方法
基于Allan方差分析的陀螺仪漂移误差辨识与仿真复现
导弹增量式自适应容错控制系统设计
研发信息的增量披露能促进企业创新投入吗
提质和增量之间的“辩证”
面外轴向检测MEMS加速度计研究现状*
基于EMD的MEMS陀螺仪随机漂移分析方法
特大城市快递垃圾增量占垃圾增量93%
基于CMAES算法的加速度计多位置新型标定方法
导航算法对捷联惯导系统精度的影响分析