CN112945277A - 一种在陀螺双五表配置下的故障判别方法 - Google Patents
一种在陀螺双五表配置下的故障判别方法 Download PDFInfo
- Publication number
- CN112945277A CN112945277A CN202110178528.8A CN202110178528A CN112945277A CN 112945277 A CN112945277 A CN 112945277A CN 202110178528 A CN202110178528 A CN 202110178528A CN 112945277 A CN112945277 A CN 112945277A
- Authority
- CN
- China
- Prior art keywords
- fault
- inertial
- equation
- gyroscope
- gyro
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000005259 measurement Methods 0.000 claims abstract description 53
- 238000001514 detection method Methods 0.000 claims abstract description 15
- 238000002955 isolation Methods 0.000 claims abstract description 7
- 238000009825 accumulation Methods 0.000 claims description 18
- 238000005096 rolling process Methods 0.000 claims description 14
- 239000000126 substance Substances 0.000 claims description 6
- 238000012850 discrimination method Methods 0.000 abstract description 4
- 230000009977 dual effect Effects 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及一种在陀螺双五表配置下的故障判别方法,所述方法包括以下步骤:S1:在所述第一惯组和所述第二惯组内,分别进行故障表一致性检测,并执行故障表隔离操作;S2:判断所述第一惯组和所述第二惯组内是否存在陀螺出现二度故障的惯组;S3:若存在陀螺出现二度故障的惯组,则执行惯组间的陀螺故障判别和定位方法,检测所述陀螺出现二度故障的惯组的对应正交表是否故障。本发明能够有效利用冗余信息,满足二度及二度以上单表级故障的情况下可靠工作的需求,最大限度地对故障进行检出,同时避免误判和漏判的发生。
Description
技术领域
本发明涉及惯性导航技术领域,尤其涉及一种在陀螺双五表配置下的故障判别方法。
背景技术
为了提高捷联惯组的可靠性,目前有效的办法是采用冗余技术。载人运载火箭需要满足更高的可靠性和安全性要求,因此冗余方案覆盖故障度数较其他型号要高,必须保证惯组能在两度及以上的故障情况下能可靠工作。
现有的惯组导航,不能满足二度及二度以上单表级故障的情况下可靠工作的需求,不能有效利用冗余信息,故障的适应程度有限,系统发生误判和漏判的概率较大。
发明内容
本发明的主要目的在于克服现有技术的缺点与不足,提供一种在陀螺双五表配置下的故障判别方法,通过设置双惯组,在每个惯组中分别进行故障检测,在惯组出现二度故障时进行惯组间的故障检测,从而确定出现二度故障的惯组对应的正交表是否损坏,在损坏时进行故障隔离,能够有效利用冗余信息,满足二度及二度以上单表级故障的情况下可靠工作的需求,最大限度地对故障进行检出,同时避免误判和漏判的发生。
本发明提供了一种在陀螺双五表配置下的故障判别方法,所述双惯组包括第一惯组和第二惯组,所述第一惯组和所述第二惯组均包括五个陀螺表Wx、Wy、Wz、Ws、Wt,其中陀螺表Wx、Wy、Wz成正交安装构成正交表,陀螺表Ws、Wt为空间斜置安装,所述方法包括以下步骤:
S1:在所述第一惯组和所述第二惯组内,分别进行故障表一致性检测,并执行故障表隔离操作;
S2:判断所述第一惯组和所述第二惯组内是否存在陀螺出现二度故障的惯组;
S3:若存在陀螺出现二度故障的惯组,则执行惯组间的陀螺故障判别和定位方法,检测所述陀螺出现二度故障的惯组的对应正交表是否故障。
优选地,在所述第一惯组和第二惯组中,分别采用的判别公式和一致性故障判别定位表相同或者不同。
优选地,在所述第一惯组中,采用以下判别公式进行故障表检测:
公式3:
公式4:
公式5:
其中,为陀螺输出的角速度;Esi_x、Esi_y、Esi_z为Ws陀螺表在正交轴的投影系数;Eti_x、Eti_y、Eti_z为Wt陀螺表在正交轴的投影系数;εGis、εGit、εGixy、εGixz、εGiyz为故障门限值;Δt3为滚动累加周期;α=x、y、z、s、t;i=1、2。
优选地,根据判别公式1-5以及陀螺角速度一致性故障判别定位表判别第一惯组中的故障表,所述陀螺角速度一致性故障判别定位表为:
序号 | 公式1 | 公式2 | 公式3 | 公式4 | 公式5 | 判别结果 |
1 | √ | √ | √ | √ | √ | 第一惯组无故障 |
2 | × | × | × | × | √ | Wx表故障 |
3 | × | × | × | √ | × | Wy表故障 |
4 | × | × | √ | × | × | Wz表故障 |
5 | × | √ | × | × | × | Ws表故障 |
6 | √ | × | × | × | × | Wt表故障 |
其它 | × | × | × | × | × | 第一惯组中2个表及以上故障 |
其中,表中“√”表示公式成立;“×”表示公式不成立。
优选地,在所述第二惯组中,采用以下判别公式进行故障表检测:
公式8:
公式9:
公式10:
其中,为陀螺输出的角速度;Esi_x、Esi_y、Esi_z为Ws陀螺表在正交轴的投影系数;Eti_x、Eti_y、Eti_z为Wt陀螺表在正交轴的投影系数;εGis、εGit、εGixy、εGixz、εGiyz为故障门限值;Δt3为滚动累加周期;α=x、y、z、s、t;i=1、2。
优选地,根据判别公式6-10以及陀螺角速度一致性故障判别定位表判别第二惯组中的故障表,所述陀螺角速度一致性故障判别定位表为:
其中,表中“√”表示公式成立;“×”表示公式不成立。
优选地,所述执行惯组间的陀螺故障判别和定位方法,包括采用以下公式进行判别:
其中,δθβi0为陀螺输出的角速度;εGx、εGy、εGz为故障门限值;Δt3为滚动累加周期;β=x、y、z,i=1、2。
优选地,根据以下真值表检测所述陀螺出现二度故障的惯组的对应正交表是否故障:
优选地,对角速度一致性判别进行滚动累加,累加周期为Δt3=25·τ,τ为控制周期;故障门限根据陀螺仪的测量误差σ来确定,取值范围为[6σ,9σ]。
优选地,记录陀螺表和加速度表的连续故障次数,对连续故障次数超过预定门限的陀螺表和加速度表进行隔离。
有益效果:通过配置陀螺双五表惯组,在每个惯组中分别进行故障检测,在惯组出现陀螺表二度故障时进行惯组之间的故障检测,从而确定出现二度故障的惯组对应的正交表是否损坏,在损坏时进行故障隔离,能够有效利用冗余信息,满足二度及二度以上单表级故障的情况下可靠工作的需求,最大限度地对故障进行检出,同时避免误判和漏判的发生。
通过参照以下附图及对本发明的具体实施方式的详细描述,本发明的特征及优点将会变得清楚。
附图说明
图1是陀螺双惯组的故障判别方法流程示意图;
图2是惯性仪表安装定向示意图;
图3是双惯组配置示意图。
具体实施方式
下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图1是陀螺双惯组的故障判别方法流程示意图。如图1所示,本发明提供了一种在陀螺双五表配置下的故障判别方法,所述双惯组包括第一惯组和第二惯组,所述第一惯组和所述第二惯组均包括五个Wx、Wy、Wz、Ws、Wt,其中陀螺表Wx、Wy、Wz成正交安装构成正交表,陀螺表Ws、Wt为空间斜置安装,所述方法包括以下步骤:
S1:在所述第一惯组和所述第二惯组内,分别进行故障表一致性检测,并执行故障表隔离操作;
S2:判断所述第一惯组和所述第二惯组内是否存在陀螺出现二度故障的惯组;
S3:若存在陀螺出现二度故障的惯组,则执行惯组间的陀螺故障判别和定位方法,检测所述陀螺出现二度故障的惯组的对应正交表是否故障。
如图2和图3所示,本发明的双惯组为陀螺双五表配置冗余结构。在图2中,O-X1Y1Z1为箭体坐标系,其中OX1为纵轴,OY1为法向轴,OZ1为横向轴;O-XsYsZs为惯性组合坐标系。两套惯组并排安装,各单表敏感轴互相平行。
在图3中,五个陀螺Wx、Wy、Wz、Ws、Wt固定在同一基准面上。Wx、Wy、Wz分别沿OXs、OYs、OZs轴方向成正交安装,测量轴正向为箭头所指方向,Ws、Wt为空间斜置,测量轴具体指向可以由单机确定。
优选地,在所述第一惯组和第二惯组中,分别采用的判别公式和一致性故障判别定位表相同或者不同。
作为一个优选实施例,在所述第一惯组中,针对角速度信息,可以进行各表在正交轴投影合理性进行判别,角速度一致性判别采用以下判别公式进行:
公式3:
公式4:
公式5:
其中,为陀螺输出的角速度;Esi_x、Esi_y、Esi_z为Ws陀螺表在正交轴的投影系数;Eti_x、Eti_y、Eti_z为Wt陀螺表在正交轴的投影系数;εGis、εGit、εGixy、εGixz、εGiyz为故障门限值;Δt3为滚动累加周期;α=x、y、z、s、t;i=1、2。
为降低高频干扰信号对故障诊断的影响,对角速度一致性判别进行滚动累加,累加周期为Δt3=25·τ(τ为控制周期20ms),累加时间段从开20ms中断以后开始,为防止长时间滚动累加误差造成影响,在允许起飞时刻进行一次清零,之后重新开始滚动累加。
优选地,根据判别公式1-5以及陀螺角速度一致性故障判别定位表判别第一惯组中的故障表,所述陀螺角速度一致性故障判别定位表为:
序号 | 公式1 | 公式2 | 公式3 | 公式4 | 公式5 | 判别结果 |
1 | √ | √ | √ | √ | √ | 第一惯组无故障 |
2 | × | × | × | × | √ | Wx表故障 |
3 | × | × | × | √ | × | Wy表故障 |
4 | × | × | √ | × | × | Wz表故障 |
5 | × | √ | × | × | × | Ws表故障 |
6 | √ | × | × | × | × | Wt表故障 |
其它 | × | × | × | × | × | 第一惯组中2个表及以上故障 |
其中,表中“√”表示公式成立;“×”表示公式不成立。
第二惯组中采用的判别公式可以与第一惯组中采用的公式相同,优选地,在所述第二惯组中,采用以下判别公式进行故障表检测:
公式8:
公式9:
公式10:
其中,为陀螺输出的角速度;Esi_x、Esi_y、Esi_z为Ws陀螺表在正交轴的投影系数;Eti_x、Eti_y、Eti_z为Wt陀螺表在正交轴的投影系数;εGis、εGit、εGixy、εGixz、εGiyz为故障门限值;Δt3为滚动累加周期;α=x、y、z、s、t;i=1、2。
优选地,根据判别公式6-10以及陀螺角速度一致性故障判别定位表判别第二惯组中的故障表,所述陀螺角速度一致性故障判别定位表为:
其中,表中“√”表示公式成立;“×”表示公式不成立。
如果通过公式判断出其中一个惯组陀螺出现二度故障,则可以通过以下公式11-13检测出现二度故障惯组的对应正交表是否损坏。具体公式如下:
其中,δθβi0为陀螺输出的角速度;εGx、εGy、εGz为故障门限值;Δt3为滚动累加周期;β=x、y、z,i=1、2。
优选地,根据以下真值表检测所述陀螺出现二度故障的惯组的对应正交表是否故障:
如果第一惯组、第二惯组都出现一致性故障,则用上述判断的结果,尽量选择相应的无故障的正交表进行导航计算。
上述公式中角速度一致性故障门限,可以通过理论计算和分析得到,一般情况下,预设的门限根据惯性测量器件的测量误差σ来确定。本实施例中,故障门限根据陀螺仪的测量误差σ来确定,取值范围为[6σ,9σ]。
例如:角速度相关故障门限考虑因素如下表所示:
序号 | 影响因素 | 数值 |
1 | 陀螺仪零位误差 | 0.1°/h(1σ) |
2 | 陀螺仪比例误差 | 1×10<sup>-4</sup>(1σ) |
3 | 陀螺仪安装误差 | 1×10<sup>-4</sup>(1σ) |
4 | 陀螺仪测量范围 | 100°/s |
陀螺仪角增量一致性门限值,主要考虑陀螺仪零位误差、比例误差、采样误差、安装误差、惯组相对安装误差等因素,如果按9σ取值,则确定判断门限为:
εGxT=εGyT=εGzT=εGs=εGt=0.18025°/s·0.02·25=0.0901°。
上述给出的例子只是简单的示例门限的确定方法,实际工程应用中,考虑的误差项可能更复杂,也可以采用均方和等其它数学处理方式进行计算。
优选地,记录陀螺表和加速度表的连续故障次数,对连续故障次数超过预定门限的陀螺表和加速度表进行隔离。
通过隔离惯组中故障的陀螺表,然后进行系统重构,选择无故障的正交表进行导航计算,在隔离并完成系统重构后,在故障适应能力上明显提高,可以应对二度及二度以上的单表故障。
本发明通过配置陀螺双五表惯组,在每个惯组中分别进行故障检测,在惯组陀螺出现二度故障时进行惯组间的故障检测,从而确定出现二度故障的惯组对应的正交表是否损坏,在损坏时进行故障隔离,能够有效利用冗余信息,满足二度及二度以上单表级故障的情况下可靠工作的需求,最大限度地对故障进行检出,同时避免误判和漏判的发生。
以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是在本发明的构思下,利用本发明说明书及附图内容所作的等效结构变换,或直接/间接运用在其他相关的技术领域均包括在本发明的专利保护范围内。
Claims (10)
1.一种在陀螺双五表配置下的故障判别方法,其特征在于,所述双惯组包括第一惯组和第二惯组,所述第一惯组和所述第二惯组均包括五个陀螺表Wx、Wy、Wz、Ws、Wt,其中陀螺表Wx、Wy、Wz成正交安装构成正交表,陀螺表Ws、Wt为空间斜置安装,所述方法包括以下步骤:
S1:在所述第一惯组和所述第二惯组内,分别进行故障表一致性检测,并执行故障表隔离操作;
S2:判断所述第一惯组和所述第二惯组内是否存在陀螺出现二度故障的惯组;
S3:若存在陀螺出现二度故障的惯组,则执行惯组间的陀螺故障判别和定位方法,检测所述陀螺出现二度故障的惯组的对应正交表是否故障。
2.根据权利要求1所述的方法,其特征在于,在所述第一惯组和第二惯组中,分别采用的判别公式和一致性故障判别定位表相同或者不同。
4.根据权利要求3所述的方法,其特征在于,根据判别公式1-5以及陀螺角速度一致性故障判别定位表判别第一惯组中的故障表,所述陀螺角速度一致性故障判别定位表为:
其中,表中“√”表示公式成立;“×”表示公式不成立。
9.根据权利要求3或5所述的方法,其特征在于,对角速度一致性判别进行滚动累加,累加周期为Δt=25·τ,τ为控制周期;故障门限根据陀螺仪的测量误差σ来确定,取值范围为[6σ,9σ]。
10.根据权利要求1所述的方法,其特征在于,记录陀螺表和加速度表的连续故障次数,对连续故障次数超过预定门限的陀螺表和加速度表进行隔离。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110178528.8A CN112945277B (zh) | 2021-02-09 | 2021-02-09 | 一种在陀螺双五表配置下的故障判别方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110178528.8A CN112945277B (zh) | 2021-02-09 | 2021-02-09 | 一种在陀螺双五表配置下的故障判别方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112945277A true CN112945277A (zh) | 2021-06-11 |
CN112945277B CN112945277B (zh) | 2024-06-11 |
Family
ID=76244822
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110178528.8A Active CN112945277B (zh) | 2021-02-09 | 2021-02-09 | 一种在陀螺双五表配置下的故障判别方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112945277B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101738499A (zh) * | 2009-12-24 | 2010-06-16 | 北京航天自动控制研究所 | 一种在加速度表八表配置下的故障诊断方法 |
CN102927995A (zh) * | 2012-10-24 | 2013-02-13 | 北京航天自动控制研究所 | 一种在五个陀螺仪配置下的一致性故障诊断方法 |
US20150006019A1 (en) * | 2013-06-28 | 2015-01-01 | Dassault Aviation | Method for detecting a failure of at least one sensor onboard an aircraft implementing an anemo-inertial loop, and associated system |
CN109813309A (zh) * | 2019-03-08 | 2019-05-28 | 哈尔滨工程大学 | 一种六陀螺冗余式捷联惯导系统双故障隔离方法 |
CN110017851A (zh) * | 2019-04-23 | 2019-07-16 | 西北工业大学 | 一种冗余捷联惯组二度故障检测方法 |
-
2021
- 2021-02-09 CN CN202110178528.8A patent/CN112945277B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101738499A (zh) * | 2009-12-24 | 2010-06-16 | 北京航天自动控制研究所 | 一种在加速度表八表配置下的故障诊断方法 |
CN102927995A (zh) * | 2012-10-24 | 2013-02-13 | 北京航天自动控制研究所 | 一种在五个陀螺仪配置下的一致性故障诊断方法 |
US20150006019A1 (en) * | 2013-06-28 | 2015-01-01 | Dassault Aviation | Method for detecting a failure of at least one sensor onboard an aircraft implementing an anemo-inertial loop, and associated system |
CN109813309A (zh) * | 2019-03-08 | 2019-05-28 | 哈尔滨工程大学 | 一种六陀螺冗余式捷联惯导系统双故障隔离方法 |
CN110017851A (zh) * | 2019-04-23 | 2019-07-16 | 西北工业大学 | 一种冗余捷联惯组二度故障检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112945277B (zh) | 2024-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107885219B (zh) | 用于监控无人机飞行的飞行监控系统和方法 | |
CN107421534B (zh) | 一种冗余式捷联惯导系统多故障隔离方法 | |
CN111060133B (zh) | 一种用于城市复杂环境的组合导航完好性监测方法 | |
CN1932444B (zh) | 适用于高速旋转体的姿态测量方法 | |
CN110196049A (zh) | 一种动态环境下四陀螺冗余式捷联惯导系统硬故障检测与隔离方法 | |
CN102927995B (zh) | 一种在五个陀螺仪配置下的一致性故障诊断方法 | |
CN110567457B (zh) | 一种基于冗余的惯导自检测系统 | |
CN108981709B (zh) | 基于力矩模型辅助的四旋翼横滚角、俯仰角容错估计方法 | |
CN112650281B (zh) | 多传感器三余度系统、控制方法、无人机、介质及终端 | |
CN108981708B (zh) | 四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法 | |
CN109813309A (zh) | 一种六陀螺冗余式捷联惯导系统双故障隔离方法 | |
US9828111B2 (en) | Method of estimation of the speed of an aircraft relative to the surrounding air, and associated system | |
CN109612459A (zh) | 基于动力学模型的四旋翼飞行器惯性传感器容错导航方法 | |
CN110843766A (zh) | 车辆姿态检测方法、装置、车载终端、车辆和介质 | |
CN109238307B (zh) | 一种基于多惯组信息辅助的飞行故障检测方法及装置 | |
CN111964695A (zh) | 一种无人机组合导航系统故障检测与隔离方法 | |
CN110203254B (zh) | 列车定位系统中卡尔曼滤波器的安全检测方法 | |
CN111141286A (zh) | 一种无人机飞控多传感器姿态置信解算方法 | |
CN110017851B (zh) | 一种冗余捷联惯组二度故障检测方法 | |
Wen et al. | Fault detection and diagnosis in the INS/GPS navigation system | |
CN112945277A (zh) | 一种在陀螺双五表配置下的故障判别方法 | |
CN112945229A (zh) | 一种双十表惯组主从冗余方法 | |
CN115790670A (zh) | 一种冗余捷联惯组故障检测方法及系统 | |
CN115468559A (zh) | 一种多源联邦滤波组合导航系统的自适应容错方法 | |
CN112528492B (zh) | 一种机翼损伤情况下的故障检测方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant |