法律状态公告日
法律状态信息
法律状态
2018-01-19
授权
授权
2016-02-24
实质审查的生效 IPC(主分类):G01C25/00 申请日:20151013
实质审查的生效
2016-01-27
公开
公开
技术领域
本发明涉及的是一种导航方法,具体地说是捷联惯导系统导航方法。
背景技术
捷联惯导系统通常采用三个互相正交安装的陀螺仪进行载体角运动测量,进而完成导航解算,而此时任何一个陀螺仪发生故障,导航系统都将无法正常工作,系统可靠性不能满足工程实际需求。另一方面,陀螺仪漂移作为系统的主要误差源将引起随时间积累的导航误差,严重地降低系统的精度性能,致使长时间工作的导航系统失效。增加陀螺仪的数量构成冗余系统并实现陀螺仪之间的最佳配置能够有效地提高系统的可靠性,同时,对捷联惯导系统采用单轴旋转调制技术,可以有效地抑制陀螺仪漂移误差引起的导航误差发散现象,从而提高系统工作精度。因此,基于冗余配置的捷联惯导系统单轴旋转调制方法,可以同时提高系统可靠性和精度,满足长时间工作条件下对系统性能的高要求,具有重要的实际应用价值。
现有的捷联惯导系统性能提升方法,采用器件级或系统级技术,仅能单一地实现系统可靠性的增强或者导航精度的提高。程建华等人在《一种对称斜置式四陀螺惯导冗余配置方案》(发表于期刊《传感器与微系统》,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可知,导航系统位置误差得到一定程度的减小;总体仿真结果表明,本发明中的冗余式单轴旋转导航系统整体的精度性能明显优于单纯的冗余式导航系统,由于该发明对陀螺常值漂移的调制作用,使速度误差、姿态误差和位置误差限制在小范围内,有效地抑制了导航误差的发散,进而提高了系统长时间的工作精度。
结合上述分析,得到如下的分析结果:通过本发明提出的基于冗余配置的捷联惯导系统单轴旋转调制方法,不仅可以有效地提升系统的可靠性,同时还可以抑制由陀螺漂移引起的各项导航输出误差。因此,本发明可以更为全面地提升导航系统性能,满足导航系统长时间高可靠性和高精度的实际应用需求。
机译: 利用地理空间信息智能系统纠正短程无人飞行器捷联惯导系统的方法
机译: 捷联惯导系统的集成方法
机译: 地下采煤机捷联惯导系统组合初始对准系统和对准方法