CN105277213A - 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 - Google Patents
一种基于冗余配置的捷联惯导系统单轴旋转调制方法 Download PDFInfo
- Publication number
- CN105277213A CN105277213A CN201510657877.2A CN201510657877A CN105277213A CN 105277213 A CN105277213 A CN 105277213A CN 201510657877 A CN201510657877 A CN 201510657877A CN 105277213 A CN105277213 A CN 105277213A
- Authority
- CN
- China
- Prior art keywords
- alpha
- gyroscope
- axis
- strapdown inertial
- omega
- 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
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
Abstract
本发明的目的在于提供一种基于冗余配置的捷联惯导系统单轴旋转调制方法,采用一种四陀螺对称斜置式冗余配置方案装备捷联惯导系统,针对构成的四陀螺冗余系统特别设计了单轴连续旋转方案,根据系统方案计算等效在载体系上的陀螺仪测量值,将其带入系统进行导航解算,实时、连续地输出载体姿态、速度及位置导航参数。本发明不仅能够提高系统的可靠性,保证系统在单个陀螺仪发生故障时仍有效工作,而且还能够在不引入任何外部信息的条件下,消除由陀螺仪漂移引起的导航误差,进而提高系统的精度性能。该方法实现了导航系统更为全面的性能提升,在很大程度上保证系统长时间的有效工作,具有很高的工程应用价值。
Description
技术领域
本发明涉及的是一种导航方法,具体地说是捷联惯导系统导航方法。
背景技术
捷联惯导系统通常采用三个互相正交安装的陀螺仪进行载体角运动测量,进而完成导航解算,而此时任何一个陀螺仪发生故障,导航系统都将无法正常工作,系统可靠性不能满足工程实际需求。另一方面,陀螺仪漂移作为系统的主要误差源将引起随时间积累的导航误差,严重地降低系统的精度性能,致使长时间工作的导航系统失效。增加陀螺仪的数量构成冗余系统并实现陀螺仪之间的最佳配置能够有效地提高系统的可靠性,同时,对捷联惯导系统采用单轴旋转调制技术,可以有效地抑制陀螺仪漂移误差引起的导航误差发散现象,从而提高系统工作精度。因此,基于冗余配置的捷联惯导系统单轴旋转调制方法,可以同时提高系统可靠性和精度,满足长时间工作条件下对系统性能的高要求,具有重要的实际应用价值。
现有的捷联惯导系统性能提升方法,采用器件级或系统级技术,仅能单一地实现系统可靠性的增强或者导航精度的提高。程建华等人在《一种对称斜置式四陀螺惯导冗余配置方案》(发表于期刊《传感器与微系统》,2015年,02期)一文中,采用一种对称斜置式四陀螺的冗余配置方案,实现了陀螺仪数量为四,即最小陀螺仪余度情况下,系统可靠性的大幅提升。但是该方法不能抑制陀螺漂移对导航精度带来的不良影响,仅对提升系统可靠性有效。张宇飞等人在《基于IMU旋转的船用激光导航系统分析与设计》(发表于期刊《海洋技术》,2009年,02期)一文中,运用单轴旋转调制技术,使惯性器件误差在旋转周期内的均值接近于零,以此来减小系统误差积累,在不使用任何外界辅助信息的情况下实现了系统精度性能的自主提升。然而,该方法无法解决惯性器件故障导致的系统失效问题,仅能在系统正常工作的前提下提高系统精度。综上所述,现有的捷联惯导性能提升方法不能同时兼顾可靠性和精度,限制了系统实际工作条件和工作效果。
发明内容
本发明的目的在于提供同时有效地提高系统可靠性和精度的一种基于冗余配置的捷联惯导系统单轴旋转调制方法。
本发明的目的是这样实现的:
本发明一种基于冗余配置的捷联惯导系统单轴旋转调制方法,其特征是:
(1)捷联惯导系统的陀螺仪数量为四个,对四个陀螺仪的安装结构采用对称斜置式冗余配置方案,构成四陀螺冗余式捷联惯导系统;
(2)安装四陀螺冗余式捷联惯导系统至载体,使系统初始工作时刻的坐标系oxyz与载体系重合,其中x轴、y轴和z轴分别对应于载体系中的右、前、上坐标轴;
(3)对步骤(1)中的四陀螺冗余式惯导系统采用单轴连续旋转方案,构成四陀螺冗余式单轴旋转惯导系统;
(4)将四陀螺冗余式单轴旋转惯导系统中的四个陀螺仪的测量值分别投影到坐标系oxyz上,并进一步计算在单轴连续旋转条件下载体系上陀螺仪的等效测量值;
陀螺仪测量值变换到载体系下的测量方程为
式中,为陀螺仪测量值变换到载体系下的测量值;为由单轴旋转引起的坐标系oxyz到载体系的变换矩阵,即
为冗余配置中四陀螺仪测量值投影至坐标系oxyz上的等效测量值,即
ωr为捷联惯导系统单轴旋转角速率,即ωr=2π/Tr;α为陀螺仪测量值等效至坐标系oxyz的变换矩阵参数,由四陀螺冗余配置结构决定α=54.73°;ω1、ω2、ω3和ω4分别为四个陀螺仪的测量值;
(5)将步骤(4)计算得到的代入导航解算过程,使系统实时连续地输出载体的姿态、速度和位置的导航信息,直至导航任务结束。
本发明还可以包括:
1、所述的对称斜置式冗余配置方案为:
针对侧面为等边三角形、底面为正方形、且侧面与底面夹角为54.73°的五面体,选取底面中心为坐标系原点o,底面的两个对角线分别为x轴和y轴,z轴与x轴及y轴构成右手直角坐标系oxyz,参照该五面体安装四个陀螺仪使四个陀螺仪的测量轴相交于原点o,且分别垂直于五面体的四个侧面。
2、所述的单轴连续旋转方案为:
捷联惯导系统绕坐标系oxyz中z轴做连续旋转,旋转周期为Tr。
本发明的优势在于:本发明创新地将陀螺仪冗余技术和旋转调制技术进行有效地设计结合,可以在任何一个陀螺仪发生故障的情况下提供精确的器件测量信息用于导航解算,同时可在单轴旋转周期内平均掉冗余系统陀螺仪的等效漂移,消除由其引起的随时间积累的导航系统输出误差;本发明不同于一般的捷联惯导系统性能提升方法,可以同时保证系统长时间工作条件下的可靠性和精度,更全面地提高系统的综合性能,且具有成本低、易于设计和实现的优势,因此本发明具有很高的工程应用价值。
附图说明
图1为本发明的流程框图;
图2为本发明采用的对称斜置式四陀螺冗余配置方案;
图3为系统可靠度函数曲线;
图4为导航系统东向速度误差曲线;
图5为导航系统北向速度误差曲线;
图6为导航系统纵摇角误差曲线;
图7为导航系统横摇角误差曲线;
图8为导航系统位置误差曲线。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1~8,本发明方法的主要步骤如下:
(1)将四个单自由度陀螺仪按对称斜置式配置方案装备捷联惯导系统中,所涉及的对称斜置式配置方案如附图2所示;
针对侧面为等边三角形、底面为正方形、且侧面与底面夹角为54.73°的五面体,选取底面中心为坐标原点o,以底面的两个对角线分别为x轴和y轴,z轴与x轴及y轴构成右手直角坐标系oxyz,参照该五面体安装四个陀螺仪使四个陀螺仪的测量轴相交于原点o,且分别垂直于五面体的四个侧面。
(2)将四陀螺冗余式捷联惯导系统连同旋转机构安装至载体上,使初始时刻坐标系oxyz与载体坐标系重合,其中x轴、y轴和z轴分别对应于载体系中的右、前、上坐标轴;
(3)启动捷联惯导系统完成系统预热,利用旋转机构对四陀螺冗余式捷联惯导系统采用单轴连续旋转方案;
所涉及的旋转方案为
捷联惯导系统绕坐标系oxyz中z轴做连续旋转,旋转周期为Tr;
(4)在进行导航解算之前,对四个陀螺仪测量值作变换等效处理,求取载体系上陀螺仪的等效测量值;
根据四陀螺冗余式单轴旋转方案,可列出陀螺仪测量值变换到载体系下的测量方程为
式中,为陀螺仪测量值变换到载体系下的测量值;为由单轴旋转引起的坐标系oxyz到载体系的变换矩阵,即
为冗余配置中四陀螺仪测量值投影至坐标系oxyz上的等效测量值,即
ωr为捷联惯导系统单轴旋转角速率,即ωr=2π/Tr;α为陀螺仪测量值等效至坐标系oxyz的变换矩阵参数,由四陀螺冗余配置结构决定α=54.73°;ω1、ω2、ω3和ω4分别为四个陀螺仪的测量值;
(5)将步骤(4)计算得到的代入导航解算过程,使系统实时、连续地输出载体的姿态、速度和位置的导航信息,直至导航任务结束。
为了验证本发明方法的合理性、可行性,通过计算系统可靠度和单个陀螺仪平均故障时间间隔,对系统可靠性进行了分析,并利用VisualStudio2010程序对所发明的基于冗余配置的捷联惯导系统单轴旋转调制方法进行了仿真分析。
可靠性分析的具体方案描述如下:
表1可靠性分析具体方案
方案三是本发明提出的冗余配置方法,方案一和方案二是对比方案,为惯导系统陀螺仪配置的常规方案;且三个方案中均采用单自由度陀螺仪。
可靠性分析的结果如下:
表2系统可靠度及平均故障时间(MTBF)
表中λ为故障率,单个陀螺仪的MTBF为1/λ。系统可靠度计算值越大,平均故障时间间隔越长说明系统的可靠性越高。从表2可以看出方案三的平均故障时间间隔较方案一和方案二分别提高了1.25倍和1.75倍;假设单个陀螺仪的MTBF为5000h,三个方案的可靠度计算值的时间函数如图3所示,图3表明方案三的可靠度明显高于方案一与方案二,且其随时间下降率小于方案一与方案二,在长时间工作情况下仍保持较高的可靠度计算值。结合上述分析可知,相较于常规的导航系统陀螺配置方案,本发明中的四陀螺对称斜置式冗余配置方案可以有效地提高系统的可靠性。
VisualStudio2010程序仿真的方案、条件及结果如下所示:
(1)仿真时间设置
仿真时长为8h,仿真步长为0.01s。
(2)载体运动设置
初始纬度45.7796°N,初始经度126.6705°E。
模拟载体静基座条件下的工作状态,即载体无线运动和角运动。
(3)单轴旋转周期设置
单轴旋转周期为3min。
(4)误差参数设置
四个陀螺仪的常值漂移分别设置为0.01°/h、0.02°/h、0.025°/h和0.015°/h;加速度计的零偏设置为3×10-5g;初始纵摇角误差为0.0104',初始横摇角误差为-0.0104'。
(5)仿真结果
依上述仿真条件,对所设计的捷联惯导系统精度性能进行仿真,图4、图5、图6、图7、图8分别为导航系统的东向速度误差曲线、北向速度误差曲线、纵摇角误差曲线、横摇角误差曲线、位置误差曲线与未施加旋转调制的冗余式导航系统对应的误差曲线的比较结果。由图4、图5、图6和图7可知,通过采用单轴旋转调制方案,由陀螺常值漂移引起的速度误差和姿态角误差被调制成振荡幅度减小、振荡周期变短的误差量;由图8可知,导航系统位置误差得到一定程度的减小;总体仿真结果表明,本发明中的冗余式单轴旋转导航系统整体的精度性能明显优于单纯的冗余式导航系统,由于该发明对陀螺常值漂移的调制作用,使速度误差、姿态误差和位置误差限制在小范围内,有效地抑制了导航误差的发散,进而提高了系统长时间的工作精度。
结合上述分析,得到如下的分析结果:通过本发明提出的基于冗余配置的捷联惯导系统单轴旋转调制方法,不仅可以有效地提升系统的可靠性,同时还可以抑制由陀螺漂移引起的各项导航输出误差。因此,本发明可以更为全面地提升导航系统性能,满足导航系统长时间高可靠性和高精度的实际应用需求。
Claims (3)
1.一种基于冗余配置的捷联惯导系统单轴旋转调制方法,其特征是:
(1)捷联惯导系统的陀螺仪数量为四个,对四个陀螺仪的安装结构采用对称斜置式冗余配置方案,构成四陀螺冗余式捷联惯导系统;
(2)安装四陀螺冗余式捷联惯导系统至载体,使系统初始工作时刻的坐标系oxyz与载体系重合,其中x轴、y轴和z轴分别对应于载体系中的右、前、上坐标轴;
(3)对步骤(1)中的四陀螺冗余式惯导系统采用单轴连续旋转方案,构成四陀螺冗余式单轴旋转惯导系统;
(4)将四陀螺冗余式单轴旋转惯导系统中的四个陀螺仪的测量值分别投影到坐标系oxyz上,并进一步计算在单轴连续旋转条件下载体系上陀螺仪的等效测量值;
陀螺仪测量值变换到载体系下的测量方程为
式中,为陀螺仪测量值变换到载体系下的测量值;为由单轴旋转引起的坐标系oxyz到载体系的变换矩阵,即
为冗余配置中四陀螺仪测量值投影至坐标系oxyz上的等效测量值,即
ωr为捷联惯导系统单轴旋转角速率,即ωr=2π/Tr;α为陀螺仪测量值等效至坐标系oxyz的变换矩阵参数,由四陀螺冗余配置结构决定α=54.73°;ω1、ω2、ω3和ω4分别为四个陀螺仪的测量值;
(5)将步骤(4)计算得到的代入导航解算过程,使系统实时连续地输出载体的姿态、速度和位置的导航信息,直至导航任务结束。
2.根据权利要求1所述的一种基于冗余配置的捷联惯导系统单轴旋转调制方法,其特征是:
所述的对称斜置式冗余配置方案为:
针对侧面为等边三角形、底面为正方形、且侧面与底面夹角为54.73°的五面体,选取底面中心为坐标系原点o,底面的两个对角线分别为x轴和y轴,z轴与x轴及y轴构成右手直角坐标系oxyz,参照该五面体安装四个陀螺仪使四个陀螺仪的测量轴相交于原点o,且分别垂直于五面体的四个侧面。
3.根据权利要求1或2所述的一种基于冗余配置的捷联惯导系统单轴旋转调制方法,其特征是:
所述的单轴连续旋转方案为:
捷联惯导系统绕坐标系oxyz中z轴做连续旋转,旋转周期为Tr。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510657877.2A CN105277213B (zh) | 2015-10-13 | 2015-10-13 | 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510657877.2A CN105277213B (zh) | 2015-10-13 | 2015-10-13 | 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105277213A true CN105277213A (zh) | 2016-01-27 |
CN105277213B CN105277213B (zh) | 2018-01-19 |
Family
ID=55146634
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510657877.2A Active CN105277213B (zh) | 2015-10-13 | 2015-10-13 | 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105277213B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105588565A (zh) * | 2016-03-08 | 2016-05-18 | 哈尔滨工程大学 | 一种基于冗余配置的捷联惯导系统双轴旋转调制方法 |
CN105716626A (zh) * | 2016-02-03 | 2016-06-29 | 中国人民解放军装备学院 | 一种悬浮类陀螺仪的定子旋转调制误差补偿方法 |
CN106767801A (zh) * | 2016-12-01 | 2017-05-31 | 北京航天时代光电科技有限公司 | 一种高可靠单轴冗余光纤陀螺惯测系统 |
CN108592946A (zh) * | 2018-04-26 | 2018-09-28 | 北京航空航天大学 | 一种基于两套旋转惯导冗余配置下的惯性器件漂移在线监控方法 |
CN109855653A (zh) * | 2019-03-08 | 2019-06-07 | 哈尔滨工程大学 | 一种冗余式mems-imu的降噪处理后的标定方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104316052A (zh) * | 2014-11-05 | 2015-01-28 | 哈尔滨工程大学 | 一种基于正交旋转的九陀螺mems惯性测量装置 |
CN104501810A (zh) * | 2015-01-21 | 2015-04-08 | 哈尔滨工程大学 | 一种基于五面体的对称斜置配置方法 |
-
2015
- 2015-10-13 CN CN201510657877.2A patent/CN105277213B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104316052A (zh) * | 2014-11-05 | 2015-01-28 | 哈尔滨工程大学 | 一种基于正交旋转的九陀螺mems惯性测量装置 |
CN104501810A (zh) * | 2015-01-21 | 2015-04-08 | 哈尔滨工程大学 | 一种基于五面体的对称斜置配置方法 |
Non-Patent Citations (3)
Title |
---|
MAHDI JAFARI ET AL.: "INERTIAL NAVIGATION ACCURACY INCREASING USING REDUNDANT SENSORS", 《JOURNAL OF SCIENCE AND ENGINEERING》 * |
XUEYUN WANG ET AL.: "Analysis and Verification of Modulation Effects on Inertial Navigation System based on MEMS Sensors", 《THE JOURNAL OF NAVIGATION》 * |
程建华等: "垂向对称的四陀螺冗余式单轴旋转捷联惯导方法", 《导航定位与授时》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105716626A (zh) * | 2016-02-03 | 2016-06-29 | 中国人民解放军装备学院 | 一种悬浮类陀螺仪的定子旋转调制误差补偿方法 |
CN105716626B (zh) * | 2016-02-03 | 2018-09-21 | 中国人民解放军装备学院 | 一种悬浮类陀螺仪的定子旋转调制误差补偿方法 |
CN105588565A (zh) * | 2016-03-08 | 2016-05-18 | 哈尔滨工程大学 | 一种基于冗余配置的捷联惯导系统双轴旋转调制方法 |
CN106767801A (zh) * | 2016-12-01 | 2017-05-31 | 北京航天时代光电科技有限公司 | 一种高可靠单轴冗余光纤陀螺惯测系统 |
CN108592946A (zh) * | 2018-04-26 | 2018-09-28 | 北京航空航天大学 | 一种基于两套旋转惯导冗余配置下的惯性器件漂移在线监控方法 |
CN109855653A (zh) * | 2019-03-08 | 2019-06-07 | 哈尔滨工程大学 | 一种冗余式mems-imu的降噪处理后的标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105277213B (zh) | 2018-01-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105588565B (zh) | 一种基于冗余配置的捷联惯导系统双轴旋转调制方法 | |
CN105277213A (zh) | 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 | |
CN103292809B (zh) | 一种单轴旋转式惯导系统及其专用误差自补偿方法 | |
CN103900571B (zh) | 一种基于惯性坐标系旋转型捷联惯导系统的载体姿态测量方法 | |
CN104897178B (zh) | 一种双惯导联合旋转调制导航与在线相对性能评估方法 | |
CN100559189C (zh) | 一种惯性测量单元的无定向多位置高精度标定方法 | |
CN101419080B (zh) | 微型捷联惯性测量系统的零速校正方法 | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN104596546B (zh) | 一种单轴旋转惯导系统的姿态输出补偿方法 | |
CN101629826A (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法 | |
CN102589546B (zh) | 一种抑制器件斜坡误差影响的光纤捷联惯组往复式两位置寻北方法 | |
CN103090866B (zh) | 一种单轴旋转光纤陀螺捷联惯导系统速度误差抑制方法 | |
CN103335649B (zh) | 一种惯性导航系统极区导航参数解算方法 | |
CN105628025B (zh) | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 | |
CN101701825A (zh) | 高精度激光陀螺单轴旋转惯性导航系统 | |
CN103900607A (zh) | 一种基于惯性系的旋转式捷联惯导系统转位方法 | |
CN104567874A (zh) | 一种基于激光惯导的车载定位定向及自标定装置 | |
CN102798399A (zh) | 基于双轴转动方案的捷联惯导系统误差抑制方法 | |
CN112179340B (zh) | 一种冗余配置惯性测量单元双轴旋转调制方法 | |
CN103900566B (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 | |
CN103148854A (zh) | 基于单轴正反转动的mems惯导系统姿态测量方法 | |
CN102519485A (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN102788598A (zh) | 基于三轴旋转的光纤捷联惯导系统误差抑制方法 | |
CN103940445A (zh) | 一种单轴旋转惯导系统惯性器件误差补偿方法 | |
CN102538789B (zh) | 一种双轴连续旋转调制式惯性导航系统的旋转方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |