CN106052682B - 一种混合式惯性导航系统及导航方法 - Google Patents
一种混合式惯性导航系统及导航方法 Download PDFInfo
- Publication number
- CN106052682B CN106052682B CN201610318479.2A CN201610318479A CN106052682B CN 106052682 B CN106052682 B CN 106052682B CN 201610318479 A CN201610318479 A CN 201610318479A CN 106052682 B CN106052682 B CN 106052682B
- Authority
- CN
- China
- Prior art keywords
- platform
- navigation
- strapdown
- inertial
- inertial navigation
- 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
Classifications
-
- 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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- 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
- G01C21/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种混合式惯性导航系统及方法,所述系统是指集平台式惯导系统结构、捷联式惯导系统算法和旋转式惯导系统误差抑制技术于一体的惯导系统,它将基于伺服控制的物理稳定平台与基于捷联姿态计算的数学平台有机结合,用物理稳定平台一方面隔离载体角运动和跟踪地理坐标系,减小惯性测量误差,一方面使惯性器件相对地理坐标系进行旋转,有效抑制惯性器件的常值漂移等;用捷联姿态计算构建数学平台,可避免平台稳定控制精度对系统导航定位精度的直接影响。本发明可满足在提高导航定位精度以及降低购置/维护成本等方面不断增长的新需求,为惯性导航技术的发展开辟了一条新的技术途径。
Description
技术领域
本发明涉及一种集平台式、捷联式和旋转式惯性导航之大成的惯导系统,属于惯性导航领域。
背景技术
平台式惯性导航系统一般用四环平台隔离载体角运动,使惯性测量始终在当地地理坐标系内进行,可解决载体角运动耦合造成的测量误差,同时还可大大降低惯性测量的角速度范围,系统精度较高,但存在结构复杂,体积重量偏大,可靠性较差,成本较高等缺点。捷联式惯性导航系统将惯性器件与机体固连,角速度、加速度经姿态矩阵实时变换到地理坐标系再进行导航解算,与平台式惯导相比具有体积重量小、成本低、可靠性高等优点,但是当航向变化时初始对准所建立的惯性器件误差与数学平台偏角间的平衡关系会被破坏,从而引起明显导航误差。旋转式惯性导航系统通过相对壳体的旋转运动来抑制惯性器件常值漂移,是一种在利用同等精度惯性器件的情况下大幅提高系统导航精度的有效手段,已在舰船领域得到应用,但旋转式惯导仍有较大提升空间,特别是在应用到航空、航天等领域时,在技术途径上还需创新。混合式惯导系统将隔离载体角运动的“物理平台”与借助捷联算法构建的“数学平台”相结合,还具备通过旋转调制抑制惯性器件误差的功能,为惯性导航技术的发展开辟一条新的技术途径。由“平台”到“捷联”,再由“捷联”到“平台”,这是事物“否定之否定”螺旋式上升规律的体现。除了需求牵引外,技术进步也成为这项转变的推手,此处的平台已大大不同于传统的平台,其体积、重量和可靠性方面的指标已有重大提升。
发明内容
本发明解决的技术问题是:最大限度地发挥平台式、捷联式和旋转式惯导的各自优点,避免各自的不足,从系统层面发挥好惯性器件的性能,为研制高性能惯导系统提供一种新的解决方案。
本发明的技术解决方案是:一种混合式惯性导航系统,其特点在于:系统既有基于伺服控制的物理稳定平台又有基于捷联算法的数学平台,还有基于旋转调制的误差抑制方法;所述的物理平台包括框架平台和惯性测量单元等,框架平台为惯性测量单元隔离载体的角运动,并使惯性测量单元做周期性的旋转运动;所述的数学平台包括捷联姿态计算和导航计算等,用捷联姿态阵修正惯性测量单元提供的速度增量和角度增量,然后进行导航计算。
本发明的原理是:混合式惯导系统的物理稳定平台具有旋转轴,可以隔离载体角运动,使初始对准过程中所建立的水平平台偏角与加速度计零偏的平衡、罗经效应项与等效东向陀螺漂移的平衡在整个导航过程中基本能得到保持,并降低陀螺比例系数误差和安装误差角对系统精度的影响。用捷联算法构建的数学平台可以计算出物理稳定平台的控制误差,并用其在导航解算时进行补偿修正,从而降低平台控制误差对导航精度的影响。陀螺漂移和加速度计零偏是影响惯导精度的两个主要因素,当惯性测量单元做周期性的旋转时,陀螺漂移和加速度计零偏可被调制为零均值的形式,从而大大降低对系统的影响,实现高精度导航。
本发明与现有技术相比的优点在于:
(1)本发明用物理稳定平台降低载体角运动对导航精度的影响,使旋转调制技术不仅可用于低动态的舰船领域,还可以扩展到高动态的航空、航天领域;若惯性器件的性能一样,则本系统导航定位精度可得到成倍提高;若要实现同样的系统导航定位精度,则本发明可降低对惯性器件精度的要求,从而降低系统成本。
(2)本发明在有物理稳定平台的情况下还用数学方法计算捷联姿态阵,相比传统平台式惯导,能降低物理稳定平台的控制精度对系统导航定位精度的影响。
(3)本发明的旋转调制是在隔离了载体角运动的情况下执行,所以旋转是相对于地理坐标系进行,这比相对于壳体旋转的系统能获得更好的误差抑制效果。
附图说明
图1为本发明混合式惯性导航系统原理框图;
图2为本发明实施例中系统整体结构示意图;
图3为本发明实施例中物理稳定平台结构示意图;
图4为本发明实施例中惯性测量单元整体结构示意图;
图5为本发明实施例中惯性测量单元内部结构示意图;
图6为本发明实施例中系统车载导航实验的位置误差曲线;
图7为本发明实施例中系统按传统方案导航的位置误差曲线。
具体实施方式
混合式惯性导航系统可以用多种惯性器件来实现,并且根据应用场合的不同,物理平台在结构上也可以有三轴、双轴、单轴等多种实现形式,下面以基于光纤陀螺的三轴混合式机载惯性导航系统为例来阐述本发明的具体实施过程。
本发明的所述系统是指集平台式惯导系统结构、捷联式惯导系统算法和旋转式惯导系统误差抑制技术于一体的惯导系统,它将基于伺服控制的物理稳定平台与基于捷联姿态计算的数学平台有机结合,用物理稳定平台一方面隔离载体角运动和跟踪地理坐标系,减小惯性测量误差,一方面使惯性器件相对地理坐标系进行旋转,有效抑制惯性器件的常值漂移等;用捷联姿态计算构建数学平台,可避免平台稳定控制精度对系统导航定位精度的直接影响。本发明可满足在提高导航定位精度以及降低购置/维护成本等方面不断增长的新需求,为惯性导航技术的发展开辟了一条新的技术途径。
如图1所示,该系统包括物理平台和数学平台两部分,物理平台既是数学平台进行计算的数据来源,又是数学平台计算结果的执行机构。首先物理平台将隔离了载体角运动后的惯性测量单元数据和框架平台的数据发送给数学平台,然后数学平台进行相应计算,计算结束后,一方面对外输出导航结果,一方面产生控制信号去控制物理平台的电机。具体来说,当载体有角速度时,它与平台的角速度一起通过摩擦产生力矩MT,该力矩与扰动力矩MD、电机控制力矩MC共同作用于框架平台,使安装于框架平台上的惯性测量单元匀速转动。上述运动被惯性测量单元和框架平台敏感到,惯性测量单元输出角增量和速度增量框架平台输出三个框架的转角θp(中框)、γp(外框)和ψp(内框)。数学平台首先根据计算捷联姿态阵ΔC,具体方法与捷联式惯导系统一样,然后结合θp、γp和ψp按式(1)和式(2)计算载体的俯仰角θI、横滚角γI和航向角ψI。接下来是导航计算,得到载体的速度和位置并对外输出,其计算方法与捷联式惯导系统一样;稳定指令角速度的计算,以及跟踪计算得到跟踪指令角速度其方法与平台式惯导系统一样,这些都不做赘述。
其中,C为载体的姿态矩阵,c11~c33为该矩阵的各个元素,其余符号如前文所述。
最后按式(3)计算综合控制指令角速度控制器再像平台式惯导那样根据控制指令去控制电机的运动。
其中,是旋转指令角速度。这里的旋转指令角速度是混合式惯导系统引入旋转调制的具体体现,该角速度与旋转式惯导系统一样,可由用户根据使用需求进行配置。
如图2所示,系统机箱由平台舱1和电子舱2两个主要的部分构成。电子舱2包括导航/控制计算机板201和电机功放板202两块电路板。导航/控制计算机板201完成导航计算,并产生控制电机所需的脉宽调制信号,混合式惯导系统的数学平台即建立在该电路板的导航计算机内;电机功放板202对导航/控制计算机板输出的脉宽调制PWM信号进行功率放大,然后去驱动电机做旋转运动。平台舱1里安装该系统的物理平台,包括框架平台3和惯性测量单元4,惯性测量单元4与框架平台3的内框连接,框架平台3的外框通过减震器5安装到机箱上。
如图3所示,框架平台3的三个旋转轴由内向外分别是Z轴、X轴和Y轴,依次沿载体的方位、俯仰和横滚方向。初始零位状态下,三个旋转轴相互正交。内框码盘301和内框电机302,中框码盘303和中框电机304,外框码盘305和外框电机306分别安装于各自旋转轴的两端,方位轴再安装导电滑环307。当载体不存在连续翻滚运动时,框架平台的俯仰轴和横滚轴可不安装导电滑环,而是采用软导线连接。另外,当系统检测到载体出现了非正常翻滚运动,混合式惯导系统可随即将俯仰、横滚两个轴进行电锁定,通过捷联计算来进行数学隔离,也能使系统正常工作。
如图4和图5所示,惯性测量单元4由三个光纤陀螺、三个石英挠性加速度计和电路板等组成。X陀螺501、Y陀螺502、X加速度计601、Y加速度计602安装于水平方向,Z陀螺503和Z加速度计603安装于铅垂方向。电路板包括I/F转换电路板401和数据采集电路板402,它们均通过四个角的螺孔安装于惯性测量单元4。数据采集电路板402在完成对陀螺角度增量和加速度计速度增量的采样之后,将采样结果存入数据采集计算机的数组,然后数据采集计算机再通过RS-422总线将数组中的数据依次传送至导航/控制计算机板201进行后续计算。
在每个导航和控制计算周期里,首先获取当前时刻的陀螺角增量、加速度计速度增量和光电码盘转角值。这里直接得到的物理量均为这些器件敏感轴方向的测量值,由于系统机械结构加工和装配时存在误差,所以上述物理量首先补偿安装偏角,得到相互正交的速度和角度增量,然后进行捷联计算。该系统的导航计算采用捷联算法,不仅能降低对物理平台稳定控制性能的要求,降低控制误差对导航精度的影响,同时还能在平台控制出现故障的情况下做回中处理,让本系统工作在传统的捷联状态,不影响本系统继续导航定位。具体的捷联计算与现有的惯导系统类似,这里不作赘述。捷联计算过程中可以获得稳定角速度和跟踪角速度,叠加旋转角速度后作为框架平台上电机的控制指令角速度。
最后说明基于上述实施方案的混合式惯导系统所实现的高精度导航性能。图6是一次12h车载导航实验的位置误差曲线,系统所用陀螺的精度约0.01°/h。当以CEP做衡量指标时,混合式惯导方案的定位精度约0.09n mile/h。图7是使用同一系统采用传统惯导系统方案时的位置误差曲线,定位精度约0.89n mile/h。可见,混合式惯性导航系统的定位精度较传统惯性导航系统提高了约十倍。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
最后所应说明的是:以上实施实例仅用以说明而非限制本发明的技术方案,所有的不脱离本发明的精神和范围的修改或局部替换,均应涵盖在本发明的权利要求范围当中。
Claims (4)
1.一种混合式惯性导航系统,其特征在于:包括物理平台(1)和数学平台(2);所述物理平台(1)包括框架平台和惯性测量单元,框架平台具有多个旋转轴,为惯性测量单元隔离载体的角运动和跟踪地理坐标系,减小惯性测量误差,并对惯性测量单元旋转调制,即使惯性测量单元相对地理坐标系做周期性的旋转运动,有效抑制惯性器件的常值漂移;所述数学平台(2)包括捷联姿态计算模块和导航计算模块,捷联姿态计算模块根据惯性测量单元提供的角度增量计算捷联姿态阵,导航计算模块利用该捷联姿态阵对惯性测量单元提供的速度增量进行转换,补偿框架平台的控制误差,以降低框架平台控制误差对导航计算精度的影响。
2.根据权利要求1所述的混合式惯性导航系统,其特征在于:所述对惯性测量单元旋转调制不是相对于系统机箱壳体,而是先隔离载体角运动再进行旋转,旋转调制角速度相对于壳体在地理系下为恒定值,调制效果更好。
3.根据权利要求1所述的混合式惯性导航系统,其特征在于:所述物理平台是几轴形式,取决于该混合式惯导系统的具体应用场合。
4.一种混合式惯性导航方法,其特征在于实现步骤如下:
(1)物理平台隔离载体的角运动;
(2)物理平台在隔离载体角运动的基础上再使惯性测量单元周期性地旋转;
(3)数学平台用陀螺的数据计算捷联姿态阵;
(4)数学平台用加速度计的数据和捷联姿态阵作导航计算。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610318479.2A CN106052682B (zh) | 2016-05-13 | 2016-05-13 | 一种混合式惯性导航系统及导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610318479.2A CN106052682B (zh) | 2016-05-13 | 2016-05-13 | 一种混合式惯性导航系统及导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106052682A CN106052682A (zh) | 2016-10-26 |
CN106052682B true CN106052682B (zh) | 2018-12-11 |
Family
ID=57177137
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610318479.2A Active CN106052682B (zh) | 2016-05-13 | 2016-05-13 | 一种混合式惯性导航系统及导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106052682B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106895853B (zh) * | 2017-03-24 | 2020-04-24 | 东南大学 | 一种电磁计程仪辅助船用陀螺罗经行进间对准方法 |
CN106767806B (zh) * | 2017-04-01 | 2019-10-22 | 北京航空航天大学 | 一种用于混合式惯性导航系统的物理平台 |
CN107228665B (zh) * | 2017-05-10 | 2019-08-09 | 北京航天控制仪器研究所 | 一种混合式惯性平台系统 |
CN107515014B (zh) * | 2017-09-25 | 2024-01-16 | 武汉元生创新科技有限公司 | 一种惯性器件的校准装置及校准方法 |
CN108680186B (zh) * | 2018-05-17 | 2021-02-19 | 中国人民解放军海军工程大学 | 基于重力仪平台的捷联式惯导系统非线性初始对准方法 |
CN108896045B (zh) * | 2018-06-25 | 2020-08-04 | 南京航空航天大学 | 一种无加速度计的惯性导航系统和导航方法 |
CN110488853B (zh) * | 2019-08-29 | 2021-06-08 | 北京航空航天大学 | 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 |
CN111707290A (zh) * | 2020-06-12 | 2020-09-25 | 浙江大学 | 一种三自由度的传感器自动标定转台 |
CN111879320A (zh) * | 2020-07-30 | 2020-11-03 | 湖南智航联测科技有限公司 | 一种面向教学的复合式惯性系统 |
CN111964696B (zh) * | 2020-09-14 | 2022-02-08 | 中国人民解放军战略支援部队航天工程大学 | 一种双轴旋转惯导系统载体角运动隔离调制方法 |
CN112254717B (zh) * | 2020-10-12 | 2023-10-03 | 中国科学院精密测量科学与技术创新研究院 | 一种基于冷原子干涉陀螺仪的惯性导航装置及方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1818555A (zh) * | 2006-03-29 | 2006-08-16 | 北京航空航天大学 | 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 |
CN1818556A (zh) * | 2006-03-29 | 2006-08-16 | 北京航空航天大学 | 一种小体积开环光纤陀螺捷联惯性测量装置 |
CN101290227A (zh) * | 2008-06-17 | 2008-10-22 | 北京航空航天大学 | 一种三轴光纤陀螺惯性测量单元一体化结构 |
CN105659812B (zh) * | 2006-12-29 | 2009-07-01 | 北京航天时代光电科技有限公司 | 船用一体化光纤陀螺捷联垂直基准系统 |
CN202158858U (zh) * | 2010-12-04 | 2012-03-07 | 国营红峰机械厂 | 一种基于光纤陀螺的航姿系统 |
CN102636164A (zh) * | 2012-04-18 | 2012-08-15 | 北京航空航天大学 | 一种用于高精度捷联系统的光纤陀螺imu组合 |
CN102636169A (zh) * | 2012-04-18 | 2012-08-15 | 北京航空航天大学 | 一种基于三轴一体高精度光纤陀螺的车载动态定位定向仪 |
CN103604431A (zh) * | 2013-11-21 | 2014-02-26 | 北京航空航天大学 | 一种基于三轴一体高精度光纤陀螺的捷联罗经系统 |
-
2016
- 2016-05-13 CN CN201610318479.2A patent/CN106052682B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1818555A (zh) * | 2006-03-29 | 2006-08-16 | 北京航空航天大学 | 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 |
CN1818556A (zh) * | 2006-03-29 | 2006-08-16 | 北京航空航天大学 | 一种小体积开环光纤陀螺捷联惯性测量装置 |
CN105659812B (zh) * | 2006-12-29 | 2009-07-01 | 北京航天时代光电科技有限公司 | 船用一体化光纤陀螺捷联垂直基准系统 |
CN101290227A (zh) * | 2008-06-17 | 2008-10-22 | 北京航空航天大学 | 一种三轴光纤陀螺惯性测量单元一体化结构 |
CN202158858U (zh) * | 2010-12-04 | 2012-03-07 | 国营红峰机械厂 | 一种基于光纤陀螺的航姿系统 |
CN102636164A (zh) * | 2012-04-18 | 2012-08-15 | 北京航空航天大学 | 一种用于高精度捷联系统的光纤陀螺imu组合 |
CN102636169A (zh) * | 2012-04-18 | 2012-08-15 | 北京航空航天大学 | 一种基于三轴一体高精度光纤陀螺的车载动态定位定向仪 |
CN103604431A (zh) * | 2013-11-21 | 2014-02-26 | 北京航空航天大学 | 一种基于三轴一体高精度光纤陀螺的捷联罗经系统 |
Also Published As
Publication number | Publication date |
---|---|
CN106052682A (zh) | 2016-10-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106052682B (zh) | 一种混合式惯性导航系统及导航方法 | |
CN102980577B (zh) | 一种微型捷联航姿系统及其工作方法 | |
CN106052716B (zh) | 惯性系下基于星光信息辅助的陀螺误差在线标定方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN104698485B (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
CN202974288U (zh) | 一种微型捷联航姿系统 | |
CN110162855B (zh) | 遥感卫星星上旋转载荷动态精度分析及误差分配方法 | |
CN103697878B (zh) | 一种单陀螺单加速度计旋转调制寻北方法 | |
CN103743413B (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
CN105628025B (zh) | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 | |
CN106017452B (zh) | 双陀螺抗扰动寻北方法 | |
CN102087110B (zh) | 微型水下运动体自主姿态检测装置及方法 | |
CN103712598B (zh) | 一种小型无人机姿态确定方法 | |
CN201159646Y (zh) | 捷联式多位置陀螺罗盘 | |
CN107063262A (zh) | 一种用于无人机姿态解算的互补滤波方法 | |
CN103175528A (zh) | 基于捷联惯导系统的捷联罗经姿态测量方法 | |
CN104697521A (zh) | 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法 | |
CN102135434A (zh) | 一种惯性测量单元误差补偿的方法 | |
CN110487300A (zh) | 减振装置对惯性导航系统的性能影响测试方法 | |
CN106595669B (zh) | 一种旋转体姿态解算方法 | |
CN105277210B (zh) | 一种任意安装多轴陀螺组合标定方法 | |
Xu et al. | A novel hybrid calibration method for FOG-based IMU | |
RU2373562C2 (ru) | Способ и устройство контроля горизонтальной ориентации аппарата | |
RU2487318C1 (ru) | Бесплатформенная инерциальная курсовертикаль на чувствительных элементах средней точности |
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 |