CN109668578B - 一种基于奇偶检测方程的异构陀螺组合混合诊断方法 - Google Patents
一种基于奇偶检测方程的异构陀螺组合混合诊断方法 Download PDFInfo
- Publication number
- CN109668578B CN109668578B CN201811522706.9A CN201811522706A CN109668578B CN 109668578 B CN109668578 B CN 109668578B CN 201811522706 A CN201811522706 A CN 201811522706A CN 109668578 B CN109668578 B CN 109668578B
- Authority
- CN
- China
- Prior art keywords
- gyro
- state
- heads
- meter
- star
- 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.)
- Active
Links
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
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
本发明的一种基于奇偶检测方程的异构陀螺组合混合诊断方法中,重复以下的步骤:确定陀螺表头默认使用状态,明确不同陀螺组合在星体的安装极性,排除不能同时接入的表头;根据陀螺表头的故障状态,确定陀螺表头的接入状态,计算奇偶检测方程,并根据奇偶检测方程得到的陀螺表头一致性判据,与卫星控制系统设置的陀螺表头基准值比对,诊断确定状态异常和故障的陀螺表头。本发明可以剔除由于陀螺组合在星上的安装关系不适合比较的陀螺表头,综合所有陀螺组合的表头信息和故障状态,计算奇偶检测方程,实现不同种类的陀螺组合间混合智能故障诊断,有效满足卫星控制系统敏感器单机异构长寿命和控制系统高可靠性要求。
Description
技术领域
本发明涉及一种进行陀螺组合联合诊断与切换的技术,特别涉及一种基于奇偶检测方程的异构陀螺组合混合诊断方法。
背景技术
陀螺是卫星控制系统进行惯性姿态测量的关键敏感器单机,根据设计原理可分为机械陀螺、液浮陀螺、光纤陀螺、半球谐振陀螺等,为了保证卫星控制系统的可靠性,往往采用3表头正交1表头斜装的配置、种类相同的陀螺表头组成的陀螺组合进行姿态角速度的测量,所以,以往的陀螺组合诊断技术主要包括三种,一种是基于陀螺组合单机内部提供的工作状态进行故障诊断,另一种是利用多个同类陀螺组合的各表头进行同向比较诊断,第三种是计算陀螺组合角度增量的基准值,通过将陀螺表头与基准值信息的比对,进行故障诊断。随着对卫星控制系统可靠性与安全性要求的提高,以及单一陀螺组合的寿命往往无法直接满足卫星长寿命的要求,卫星控制系统为保证敏感器的异构性和容错性,以及系统可靠性,往往同时选用不同种类的陀螺组合。因此,仅仅对同类型的陀螺组合信息进行故障诊断技术的设计已不能满足卫星控制系统长寿命、高可靠性、高安全性的要求。
发明内容
本发明涉及一种基于奇偶检测方程的异构陀螺组合混合诊断方法,是对不同种类陀螺组合的多个陀螺表头信息,使用智能混合诊断方法实现陀螺组合联合诊断与切换。
为了达到上述目的,本发明的技术方案是提供一种基于奇偶检测方程的异构陀螺组合混合诊断方法,包括如下步骤:
S1、确定陀螺表头默认使用状态,明确不同陀螺组合在星体的安装极性,根据安装极性是否可以提供星体三轴角速度测量的保证,来排除不能同时接入的表头;
S2、根据陀螺表头的故障状态,确定陀螺表头的接入状态;
S3、根据陀螺表头的接入状态,计算奇偶检测方程;
S4、根据奇偶检测方程得到的陀螺表头一致性判据,与卫星控制系统设置的陀螺表头基准值比对,诊断确定状态异常和故障的陀螺表头;
S5、重复步骤S1-S4,实现基于奇偶检测方程的异构陀螺组合混合诊断方法。
本发明采用的方法与现有技术相比,其优点和有益效果是:
本技术方案首先剔除由于陀螺组合在星上的安装关系不适合比较的陀螺表头,然后综合所有陀螺组合的表头信息,计算奇偶检测方程,实现不同种类的陀螺组合间智能混合故障诊断,有效满足卫星控制系统敏感器单机异构长寿命和控制系统高可靠性要求。
附图说明
图1是本发明基于奇偶检测方程的异构陀螺组合混合诊断方法的流程图。
图2是本发明提供的光纤陀螺组合在星体上的安装极性。
图3是本发明提供的半球谐振陀螺组合在星体上的安装极性。
具体实施方式
如图1所示,本发明提供的一种基于奇偶检测方程的异构陀螺组合混合诊断方法中,包括如下步骤:
1、确定陀螺表头默认使用状态,明确不同陀螺组合在星体的安装极性,由于某些安装极性无法提供星体三轴角速度测量的保证,因此确定排除不能同时接入的表头;
2、根据陀螺表头的故障状态,确定陀螺表头的接入状态;
3、根据陀螺表头的接入状态,计算奇偶检测方程;
4、根据奇偶检测方程得到的陀螺表头一致性判据,与卫星控制系统设置的陀螺表头基准值比对,诊断确定状态异常和故障的陀螺表头;
5、重复上述步骤,实现基于奇偶检测方程的异构陀螺组合混合诊断方法。
本发明假定卫星控制系统配置1台光纤陀螺组合和1台半球谐振陀螺组合,每台陀螺组合各有4个陀螺表头。
1、确定陀螺表头默认使用状态,明确不同陀螺组合在星体的安装极性,由于某些安装极性无法提供星体三轴角速度测量的保证,因此确定排除不能同时接入的表头:
对陀螺表头分别编号,光纤陀螺组合表头为1、2、3、4,半球谐振陀螺组合表头为5、6、7、8,使用接入状态标志FJ表示系统接入的陀螺表头状态,默认使用表头1~5,即FJ1..5=1。
表1陀螺组合状态定义表
表头序号 | 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 备注 |
接入状态FJ | 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 | 接入为1 |
异常状态FY | 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 | 异常为1 |
故障状态FG | 0 | 0 | 0 | 0 | 0 | 0 | 0 | 0 | 故障为1 |
明确不同陀螺组合在星体的安装极性,安装极性详见图2、图3,以附图的安装极性为例,由于某些安装极性无法提供星体三轴角速度测量的保证,因此确定排除不能同时接入的表头为陀螺表头1和8,即FJ1和FJ8不能同时为1。
2、根据陀螺表头故障状态确定陀螺表头的接入状态:
若光纤陀螺组合表头正常状态数量大于2个,即FG1+FG2+FG3+FG4<2,接入状态FJ按故障状态FG最小值确定,以光纤陀螺表头优先接入;否则,接入状态FJ按故障状态FG最大值确定,以半球谐振陀螺优先接入使用。
3、根据陀螺表头的接入状态,计算奇偶检测方程:
光纤陀螺组合和半球谐振陀螺组合均由三正交轴XYZ方向陀螺(即表头1~3和表头5~7)和斜装轴S方向陀螺(即表头4和表头8)组成。ω1..8表示陀螺表头1~8的输出测量值,ωx..z表示星体惯性角速度。
1)根据光纤陀螺组合和半球谐振陀螺组合在星体上的安装极性,其输出测量值与星体惯性角速度的关系为:
陀螺表头相对卫星星体的安装矩阵定义为:
2)根据陀螺表头的接入状态FJ,取4个表头,其输出测量值与星体惯性角速度的关系为:
3)然后计算该四个表头的一致性判据Δg:
Δg=|([-DR4(DR1...3)-1,1]ω1...4)|
4、根据上述关系,以接入状态FJ1..5=1为例,得到5个一致性判据方程如下:
Δg1=|-0.4082ω1-0.4082ω2-0.4082ω3+0.7071ω4+0ω5|
Δg2=|0.4082ω1-0.2887ω2-0.5000ω3+0ω4+0.7071ω5|
Δg3=|0.6239ω1+0.1452ω2+0ω3-0.5948ω4+0.4857ω5|
Δg4=|0.6159ω1+0ω2-0.1868ω3-0.4419ω4+0.6249ω5|
Δg5=|0ω1-0.4585ω2-0.5975ω3+0.4652ω4+0.4652ω5|
根据奇偶检测方程得到的陀螺表头一致性判据,与卫星控制系统设置的陀螺表头基准值比对,诊断确定状态异常和故障的陀螺表头。
根据上述得到5个奇偶检测方程,以接入状态FJ1..5=1为例,与卫星控制系统设定的陀螺表头基准值Δb比对,Δgi<Δb(i=1..5)诊断陀螺表头异常。
表2陀螺组合混合诊断判定表
根据陀螺表头异常状态FY判断陀螺表头故障状态FG,若连续ΔJ拍FY状态一致,则用FY更新FG值。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (4)
1.一种基于奇偶检测方程的异构陀螺组合混合诊断方法,其特征在于,包括如下步骤:
S1、确定陀螺表头默认使用状态,明确不同陀螺组合在星体的安装极性,根据安装极性是否可以提供星体三轴角速度测量的保证,来排除不能同时接入的表头;
S2、根据陀螺表头的故障状态,确定陀螺表头的接入状态;
S3、根据陀螺表头的接入状态,计算奇偶检测方程;
S4、根据奇偶检测方程得到的陀螺表头一致性判据,与卫星控制系统设置的陀螺表头基准值比对,诊断确定状态异常和故障的陀螺表头;
S5、重复步骤S1-S4,实现基于奇偶检测方程的异构陀螺组合混合诊断方法;
所述步骤S3中,光纤陀螺组合包含三正交轴XYZ方向陀螺表头1~3和斜装轴S方向陀螺表头4,半球谐振陀螺组合包含三正交轴XYZ方向陀螺表头5~7和斜装轴S方向陀螺表头8;ω1..8表示陀螺表头1~8的输出测量值,ωx..z表示星体惯性角速度;
根据光纤陀螺组合和半球谐振陀螺组合在星体上的安装极性,其输出测量值与星体惯性角速度的关系为:
陀螺表头相对卫星星体的安装矩阵定义为:
根据陀螺表头的接入状态FJ,取4个表头,其输出测量值与星体惯性角速度的关系为:
其中,接入状态FJ在表示接入时为1;D4×3根据陀螺表头的接入状态FJ,取4个表头相对卫星星体的4×3安装矩阵,接入状态FJ1..4=1,
计算该四个表头的一致性判据Δg:
Δg=|([-DR4(DR1...3)-1,1]ω1...4)|
其中,DR4为接入的表头4相对卫星星体的3×1矩阵,DR1...3为接入表头1~3相对卫星星体的3×3矩阵,
2.如权利要求1所述基于奇偶检测方程的异构陀螺组合混合诊断方法,其特征在于,
卫星控制系统配置1台光纤陀螺组合和1台半球谐振陀螺组合,每台陀螺组合各有4个陀螺表头;
步骤S1中,提供陀螺组合状态定义表,对陀螺表头分别编号,光纤陀螺组合表头为1、2、3、4,半球谐振陀螺组合表头为5、6、7、8;异常状态FY在表示异常时为1;故障状态FG在表示故障时为1;
确定陀螺表头默认使用状态,明确不同陀螺组合在星体的安装极性,根据安装极性是否可以提供星体三轴角速度测量的保证,确定排除不能同时接入的表头,即接入状态FJ不能同时为1的表头。
3.如权利要求2所述基于奇偶检测方程的异构陀螺组合混合诊断方法,其特征在于,
步骤S2中,若光纤陀螺组合表头正常状态数量大于2个,即FG1+FG2+FG3+FG4<2,接入状态FJ按故障状态FG最小值确定,以光纤陀螺表头优先接入;否则,接入状态FJ按故障状态FG最大值确定,以半球谐振陀螺优先接入使用。
4.如权利要求3所述基于奇偶检测方程的异构陀螺组合混合诊断方法,其特征在于,
步骤S4中,根据陀螺表头异常状态FY判断陀螺表头故障状态FG,若连续ΔJ拍FY状态一致,则用FY更新FG值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811522706.9A CN109668578B (zh) | 2018-12-13 | 2018-12-13 | 一种基于奇偶检测方程的异构陀螺组合混合诊断方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811522706.9A CN109668578B (zh) | 2018-12-13 | 2018-12-13 | 一种基于奇偶检测方程的异构陀螺组合混合诊断方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109668578A CN109668578A (zh) | 2019-04-23 |
CN109668578B true CN109668578B (zh) | 2020-08-25 |
Family
ID=66145068
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811522706.9A Active CN109668578B (zh) | 2018-12-13 | 2018-12-13 | 一种基于奇偶检测方程的异构陀螺组合混合诊断方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109668578B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111637901B (zh) * | 2020-04-28 | 2021-12-07 | 北京控制工程研究所 | 一种基于非齐次方程解的多陀螺故障诊断与重构方法 |
CN113341915A (zh) * | 2021-05-27 | 2021-09-03 | 中国船舶重工集团公司第七0七研究所 | 一种四陀螺谐振惯导系统故障诊断隔离方法 |
CN114035422B (zh) * | 2021-10-09 | 2023-07-28 | 北京控制工程研究所 | 一种基于多源信息的异构陀螺故障定位及处理方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5297052A (en) * | 1989-10-16 | 1994-03-22 | The Boeing Company | Integrated fault-tolerant air data inertial reference system |
CN102116629A (zh) * | 2009-12-30 | 2011-07-06 | 中国民航大学 | 一种基于正四面体的六微机械电子陀螺配置方法 |
CN102435190A (zh) * | 2011-09-14 | 2012-05-02 | 中国航空工业第六一八研究所 | 余度传感器惯性测量装置 |
CN105043416A (zh) * | 2015-07-14 | 2015-11-11 | 哈尔滨工业大学 | 一种半球谐振陀螺组合在轨故障诊断方法 |
CN107356264A (zh) * | 2017-07-07 | 2017-11-17 | 上海航天控制技术研究所 | 一种异构陀螺组合互诊方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7805245B2 (en) * | 2007-04-18 | 2010-09-28 | Honeywell International Inc. | Inertial measurement unit fault detection isolation reconfiguration using parity logic |
-
2018
- 2018-12-13 CN CN201811522706.9A patent/CN109668578B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5297052A (en) * | 1989-10-16 | 1994-03-22 | The Boeing Company | Integrated fault-tolerant air data inertial reference system |
CN102116629A (zh) * | 2009-12-30 | 2011-07-06 | 中国民航大学 | 一种基于正四面体的六微机械电子陀螺配置方法 |
CN102435190A (zh) * | 2011-09-14 | 2012-05-02 | 中国航空工业第六一八研究所 | 余度传感器惯性测量装置 |
CN105043416A (zh) * | 2015-07-14 | 2015-11-11 | 哈尔滨工业大学 | 一种半球谐振陀螺组合在轨故障诊断方法 |
CN107356264A (zh) * | 2017-07-07 | 2017-11-17 | 上海航天控制技术研究所 | 一种异构陀螺组合互诊方法 |
Non-Patent Citations (3)
Title |
---|
一种双捷联冗余控制系统陀螺故障诊断方法;王晨等;《航空制造技术》;20100601(第10期);全文 * |
改进的四陀螺冗余捷联惯组故障诊断与隔离方法;武唯强等;《指挥控制与仿真》;20150228;第37卷(第1期);全文 * |
斜置陀螺惯导系统的故障诊断方法研究;崔北鹏;《电子质量》;20151220(第12期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN109668578A (zh) | 2019-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109668578B (zh) | 一种基于奇偶检测方程的异构陀螺组合混合诊断方法 | |
CN107885219B (zh) | 用于监控无人机飞行的飞行监控系统和方法 | |
EP0511730B1 (en) | Fault-tolerant inertial navigation system | |
US7805245B2 (en) | Inertial measurement unit fault detection isolation reconfiguration using parity logic | |
JP4783394B2 (ja) | センサの故障適応方法 | |
CN105043416B (zh) | 一种半球谐振陀螺组合在轨故障诊断方法 | |
KR101135782B1 (ko) | 네비게이션 중복성을 위한 시스템 | |
US20090143926A1 (en) | Method and apparatus for tracking center of gravity of air vehicle | |
JP2007121304A (ja) | Memsセンサシステムおよび方法 | |
CN111024124B (zh) | 一种多传感器信息融合的组合导航故障诊断方法 | |
US20100139440A1 (en) | Double-wheel control moment gyroscope | |
CN110567457A (zh) | 一种基于冗余的惯导自检测系统 | |
CN111352433A (zh) | 一种无人机水平姿态角的故障诊断方法 | |
CN109827593A (zh) | 一种基于多imu的误差自标定方法、系统及存储介质 | |
CN107356264B (zh) | 一种异构陀螺组合互诊方法 | |
CN111141286A (zh) | 一种无人机飞控多传感器姿态置信解算方法 | |
CN110058324B (zh) | 利用重力场模型的捷联式重力仪水平分量误差修正方法 | |
CN111060087B (zh) | 一种冗余配置的半球谐振陀螺惯性测量组件及测量方法 | |
US2878006A (en) | Gyroscopic apparatus for measuring rate of turn and linear acceleration | |
CN106643810B (zh) | 一种对陀螺组合测量数据的诊断方法 | |
KR102231159B1 (ko) | 중첩 관성 측정 유닛 | |
CN113532482B (zh) | 一种冗余惯性测量系统故障检测装置及检测方法 | |
CN111637901B (zh) | 一种基于非齐次方程解的多陀螺故障诊断与重构方法 | |
CN114608516A (zh) | 一种小型化雷达动态测姿设备 | |
Tran et al. | Developing an Approach for Fault Detection and Diagnosis of Angular Velocity Sensors |
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 | ||
GR01 | Patent grant |