CN101718560B - 基于单轴四位置转停方案的捷联系统的误差抑制方法 - Google Patents
基于单轴四位置转停方案的捷联系统的误差抑制方法 Download PDFInfo
- Publication number
- CN101718560B CN101718560B CN2009100732418A CN200910073241A CN101718560B CN 101718560 B CN101718560 B CN 101718560B CN 2009100732418 A CN2009100732418 A CN 2009100732418A CN 200910073241 A CN200910073241 A CN 200910073241A CN 101718560 B CN101718560 B CN 101718560B
- Authority
- CN
- China
- Prior art keywords
- imu
- carrier
- coordinate system
- rotation
- strapdown
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明提供的是一种基于单轴四位置转停方案的捷联系统误差抑制方法。(1)通过GPS确定载体的初始位置参数;(2)采集光纤陀螺仪输出和加速度计输出的数据并对数据进行处理;(3)惯性测量单元绕着载体方位轴固定的四个位置正反转停;(4)将IMU旋转后光纤陀螺仪和石英加速度计生成的数据转换到导航坐标系下,得到惯性器件常值偏差的调制形式;(5)利用光纤陀螺的输出值ωis s对捷联矩阵Ts n进行更新;(6)计算IMU旋转调制后载体的速度和位置;本发明水平方向上的惯性器件常值偏差进行调制,提高导航定位精度。
Description
技术领域
本发明涉及的是一种捷联系统误差抑制方法,尤其涉及的是一种基于单轴四位置转停方案的捷联系统误差抑制方法。
背景技术
在捷联式惯导系统中,所有的惯性元件都直接安装在载体上,惯性元件的输出就是载体相对惯性空间的加速度和角速度,有计算机将载体坐标系下测得的数据变换到导航坐标系再进行导航解算,这相当于在计算机内虚拟了一个平台作为导航计算的参考。由于取消了平台结构,因而系统的体积大大缩小,成本和维护费也大大降低。
惯性敏感元件的误差是惯性导航系统误差的主要决定因素。从工艺上提高惯性敏感元件的精度,存在技术难度大,周期长的问题,而且也不能超越现阶段实现的可能。惯性元件误差补偿方法有两种:一是采用高精度的漂移误差补偿软件,另一种是采用系统的反转或者是旋转补偿法。
自从光学陀螺出现以后,在旋转自动补偿技术和捷联惯性导航技术的基础上出现了一种新型的惯导系统,即旋转式惯性导航系统。它具有与传统平台系统类似的框架和转轴,然而却没有稳定的平台。简而言之,此类惯导系统相当于在捷联惯导系统的外贸加上转动机构和测角装置,导航解算也采用了捷联惯导算法,这样导航计算出来的依然是载体的位置和速度信息,而导航直接计算出的姿态信息只是惯性测量单元(IMU)的姿态,这时候需要加上IMU相对载体的转动角度,就得到了载体的姿态信息。
旋转式惯性导航系统中转动机构的目的是为了在一个转动周期内让惯性元件的常值漂移对导航所产生的误差能够自动抵消,相应的技术也被称为系统误差平均技术,被广泛的应用到当前的船用光学陀螺惯性导航系统中。
CNKI库中与本发明相关的公开报道有:1、《光学陀螺旋转惯导系统原理探讨》(袁保伦、饶谷音;国防科技大学学报;2006年第6期),该文章主要以静电陀螺的旋转调制方式为例讨论了单轴、双轴旋转调制方法,但是没有涉及到本文提到的单轴旋转调制方法。2、《旋转IMU在光纤捷联航姿系统中的应用》(王其、徐晓苏;中国惯性技术学报;2007年第3期),该文章主要介绍了单轴、双轴旋转方式,并在理论上给予证明。3、《捷联惯导动基座对准新方法及导航误差抑制技术研究》(练军想,国防科学技术大学博士论文,出版日2009年7月),该论文主要介绍了单轴旋转调制技术的误差补偿原理,但是文章中提到的是单轴连续旋转,没有提及本发明提出的单轴四位置转停方案。
发明内容
本发明的目的在于提供一种能够提高导航定位精度的基于单轴四位置转停方案的捷联系统误差抑制方法。
本发明的目的是这样实现的:包括以下步骤:
(1)利用全球定位系统GPS确定载体的初始位置参数,将它们装订至导航计算机中;
(2)光纤陀螺捷联惯性导航系统进行预热后采集光纤陀螺仪和石英加速度计输出的数据;
(3)IMU采用8个转停次序为一个旋转周期的转位方案;
(4)将惯性测量单元旋转后陀螺仪生成的数据转换到导航坐标系下,得到惯性器件常值偏差的调制形式;
(6)利用石英加速度计的输出值和步骤(5)计算的姿态矩阵计算出经过IMU旋转调制后载体的速度和位置。
本发明还可以包括:
1、所述的IMU采用8个转停次序为一个旋转周期的转位方案为:
次序1,IMU从A点出发顺时针转动180°到达位置C,停止时间Tt;次序2,IMU从C点出发顺时针转动90°到达位置D,停止时间Tt;次序3,IMU从D点出发逆时针转动180°到达位置B,停止时间Tt;次序4,IMU从B点出发逆时针转动90°到达位置A,停止时间Tt;次序5,IMU从A点出发逆时针转动180°到达位置C,停止时间Tt;次序6,IMU从C点出发逆时针转动90°到达位置B,停止时间Tt;次序7,IMU从B点出发顺时针转动180°到达位置D,停止时间Tt;次序8,IMU从D点出发顺时针转动90°到达位置A,停止时间Tt;IMU按照此转动顺序循环进行;水平东向轴上的IMU停顿点p3、p8与p4、p7对称于转轴中心;北向轴上的停顿点p1、p5与p2、p6对称于转轴中心;四位置转停方案仍然是转动角度为180°或90°间隔进行。
2、所述的将惯性测量单元旋转后陀螺仪生成的数据转换到导航坐标系下,得到惯性器件常值偏差的调制形式包括:
IMU水平方向上的陀螺常值漂移分别为εx和εy,载体静止条件下,IMU停顿的A、B、C、D四个位置相对于导航坐标系对称,在一个循环周期内四个固定位置上器件偏差产生的水平误差角在导航系下满足:
IMU正反转动的8个环节内,导航系水平方向上的误差角度分别表示为:
将一个完整转动周期内的IMU停顿位置和转动过程的东向和北向的水平误差角分别相加,得到导航系下累计的水平误差角度,
导航坐标系上水平方向上陀螺仪常值偏差得到调制,该常值偏差对系统的作用为零,水平方向上加速度计零偏也得到类似的调制。
更新四元数和姿态矩阵:
设载体坐标系相对导航坐标系的转动四元数为:
Q=q0+q1is+q2js+q3ks
其中:is、js、ks分别表示IMU坐标系oxs轴、oys轴、ozs轴上的单位方向向量;
4、所述的计算出经过IMU旋转调制后载体的速度和位置地方法为:
1)计算导航系下加速度:
2)计算载体的水平速度和位置:
根据t1时刻的载体东向水平速度Vx(t1)和北向水平速度Vy(t1),求取t1时刻载体水平速度的变化率为:
在t2时刻水平速度和载体位置分别为:
3)计算载体速度误差和位置误差:
其中:Vx0、Vy0分别表示初始时刻载体的东向和北向速度;ΔVx、ΔVy分别表示载体东向、北向速度的变化量;λ0分别表示初始时刻载体所处位置的经度和纬度;Δλ分别表示载体的纬度、经度的变化量;Rxp、Ryp分别表示地球子午圈、卯酉圈的曲率半径;t1、t2为惯导系统的解算过程中两个相邻的时间点。
本发明与现有技术相比的优点在于:本发明打破了传统捷联惯导系统中IMU与载体固连导致系统导航精度受到惯性器件偏差影响的约束,提出一种将IMU绕载体方位轴固定的四个位置正反转停的惯性器件常值偏差调制方案,该方法可以将水平方向上惯性器件常值偏差进行调制,有效地提高导航定位精度。
对本发明有益的效果说明如下:
在VC++仿真条件下,对该方法进行仿真实验:
载体处于静止状态,IMU四位置转停方案的误差模型参数:
四个位置的停顿时间:Tt=5min;
转动180°和90°时消耗的时间:Tz=12s;
转动180°和90°的过程中,每一个转位中的加减速时间各为4s;
载体初始位置:北纬45.7796°,东经126.6705°;
初始姿态误差角:三个初始姿态误差角均为零;
赤道半径:Re=6378393.0m;
椭球度:e=3.367e-3;
由万有引力可得的地球表面重力加速度:g0=9.78049;
地球自转角速度(弧度/秒):7.2921158e-5;
陀螺仪常值漂移:0.01度/小时;
加速度计零偏:10-4g0;
常数:π=3.1415926;
利用发明所述方法得到载体速度误差曲线和位置误差曲线分别如图3、图4所示。结果表明IMU四位置转停条件下,采用本发明方法可以获得较高的定位精度。
附图说明
图1为本发明的一种基于单轴四位置转停方案的捷联系统误差抑制方法流程图;
图2为本发明的IMU单轴四位置转停方案图;
图3为本发明的基于IMU单轴四位置转停方案的陀螺仪常值漂移在导航系下的调制曲线;
图4为本发明的基于IMU单轴四位置转停方案的载体速度误差与IMU静止状态时载体速度误差的对比实验曲线;
图5为本发明的基于IMU单轴四位置转停方案的载体位置误差与IMU静止状态时载体定位误差的对比实验曲线。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
(1)利用全球定位系统GPS确定载体的初始位置参数,将它们装订至导航计算机中;
(2)光纤陀螺捷联惯性导航系统进行预热后采集光纤陀螺仪和石英加速度计输出的数据;
(3)IMU采用8个转停次序为一个旋转周期的转位方案;
次序1,IMU从A点出发顺时针转动180°到达位置C,停止时间Tt;次序2,IMU从C点出发顺时针转动90°到达位置D,停止时间Tt;次序3,IMU从D点出发逆时针转动180°到达位置B,停止时间Tt;次序4,IMU从B点出发逆时针转动90°到达位置A,停止时间Tt;次序5,IMU从A点出发逆时针转动180°到达位置C,停止时间Tt;次序6,IMU从C点出发逆时针转动90°到达位置B,停止时间Tt;次序7,IMU从B点出发顺时针转动180°到达位置D,停止时间Tt;次序8,IMU从D点出发顺时针转动90°到达位置A,停止时间Tt;IMU按照此转动顺序循环进行。为了有效地对水平方向上的惯性器件偏差在对称位置上进行正负平均,定义水平东向轴上的IMU停顿点p3、p8与p4、p7对称于转轴中心;北向轴上的停顿点p1、p5与p2、p6对称于转轴中心。改进的四位置转停方案仍然是转动角度为180°或90°间隔进行。
(4)将惯性测量单元旋转后陀螺仪生成的数据转换到导航坐标系下,得到惯性器件常值偏差的调制形式;
假定IMU水平方向上的陀螺常值漂移分别为εx和εy。载体静止条件下,由于IMU停顿的A、B、C、D四个位置相对于导航坐标系对称,因此在一个循环周期内四个固定位置上器件偏差产生的水平误差角在导航系下必然满足:
IMU正反转动的8个环节内,导航系水平方向上的误差角度可以分别表示为:
将一个完整转动周期内的IMU停顿位置和转动过程的东向和北向的水平误差角分别相加,得到导航系下累计的水平误差角度。
至此,导航坐标系上水平方向上陀螺仪常值偏差得到调制,该常值偏差对系统的作用为零,水平方向上加速度计零偏也得到类似的调制。
更新四元数和姿态矩阵:
设载体坐标系相对导航坐标系的转动四元数为:
Q=q0+q1is+q2js+q3ks (6)
其中:is、js、ks分别表示IMU坐标系oxs轴、oys轴、ozs轴上的单位方向向量。
1)计算导航系下加速度:
2)计算载体的水平速度和位置:
根据t1时刻的载体东向水平速度Vx(t1)和北向水平速度Vy(t1),求取t1时刻载体水平速度的变化率为:
在t2时刻水平速度和载体位置分别为:
3)计算载体速度误差和位置误差:
Claims (3)
1.一种基于单轴四位置转停方案的捷联系统的误差抑制方法,其特征在于包括以下步骤:
(1)利用全球定位系统GPS确定载体的初始位置参数,将它们装订至导航计算机中;
(2)捷联系统进行预热后采集光纤陀螺仪和石英加速度计输出的数据;
(3)IMU采用8个转停次序为一个旋转周期的转位方案,方案为:
次序1,IMU从A点出发顺时针转动180°到达位置C,停止时间Tt;次序2,IMU从C点出发顺时针转动90°到达位置D,停止时间Tt;次序3,IMU从D点出发逆时针转动180°到达位置B,停止时间Tt;次序4,IMU从B点出发逆时针转动90°到达位置A,停止时间Tt;次序5,IMU从A点出发逆时针转动180°到达位置C,停止时间Tt;次序6,IMU从C点出发逆时针转动90°到达位置B,停止时间Tt;次序7,IMU从B点出发顺时针转动180°到达位置D,停止时间Tt;次序8,IMU从D点出发顺时针转动90°到达位置A,停止时间Tt;IMU按照此转动顺序循环进行;水平东向轴上的IMU停顿点p3、p8与p4、p7对称于转轴中心;北向轴上的停顿点p1、p5与p2、p6对称于转轴中心;四位置转停方案仍然是转动角度为180°或90°间隔进行;
(4)将IMU旋转后光纤陀螺仪生成的数据转换到导航坐标系下,得到惯性器件常值偏差的调制形式,包括:
IMU水平方向上的陀螺常值漂移分别为εx和εy,载体静止条件下,IMU停顿的A、B、C、D四个位置相对于导航坐标系对称,在一个循环周期内四个固定位置上器件偏差产生的水平误差角在导航坐标系下满足:
IMU正反转动的8个环节内,导航坐标系水平方向上的误差角度分别表示为:
将一个完整转动周期内的IMU停顿位置和转动过程的东向和北向的水平误差角分别相加,得到导航坐标系下累计的水平误差角度,
导航坐标系上水平方向上光纤陀螺仪常值偏差得到调制,该常值偏差对系统的作用为零;
3.根据权利要求2所述的一种基于单轴四位置转停方案的捷联系统的误差抑制方法,其特征在于所述的计算出经过IMU旋转调制后载体的速度和位置地方法为:
1)计算导航坐标系下加速度:
2)计算载体的水平速度和位置:
根据t1时刻的载体东向水平速度Vx(t1)和北向水平速度Vy(t1),求取t1时刻载体水平速度的变化率为:
在t2时刻水平速度和载体位置分别为:
3)计算载体速度误差和位置误差:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100732418A CN101718560B (zh) | 2009-11-20 | 2009-11-20 | 基于单轴四位置转停方案的捷联系统的误差抑制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100732418A CN101718560B (zh) | 2009-11-20 | 2009-11-20 | 基于单轴四位置转停方案的捷联系统的误差抑制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101718560A CN101718560A (zh) | 2010-06-02 |
CN101718560B true CN101718560B (zh) | 2011-11-16 |
Family
ID=42433167
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2009100732418A Expired - Fee Related CN101718560B (zh) | 2009-11-20 | 2009-11-20 | 基于单轴四位置转停方案的捷联系统的误差抑制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101718560B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102435193B (zh) * | 2011-12-07 | 2014-01-08 | 浙江大学 | 一种捷联惯性导航系统的高精度初始对准方法 |
CN102735231B (zh) * | 2012-06-21 | 2014-12-10 | 浙江大学 | 一种提高光纤陀螺寻北仪精度的方法 |
CN102788598B (zh) * | 2012-08-16 | 2014-12-03 | 辽宁工程技术大学 | 基于三轴旋转的光纤捷联惯导系统误差抑制方法 |
CN103090866B (zh) * | 2012-11-02 | 2015-05-27 | 哈尔滨工程大学 | 一种单轴旋转光纤陀螺捷联惯导系统速度误差抑制方法 |
CN103090867B (zh) * | 2012-11-02 | 2015-06-17 | 哈尔滨工程大学 | 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN103090865B (zh) * | 2013-01-06 | 2015-08-12 | 哈尔滨工程大学 | 一种调制型捷联惯性导航系统姿态误差抑制方法 |
CN103076025B (zh) * | 2013-01-07 | 2015-12-09 | 哈尔滨工程大学 | 一种基于双解算程序的光纤陀螺常值误差标定方法 |
CN103471593B (zh) * | 2013-09-06 | 2015-12-23 | 北京航天控制仪器研究所 | 一种基于gps信息的惯性导航系统测量误差修正方法 |
CN103940445B (zh) * | 2014-04-10 | 2016-08-17 | 哈尔滨工程大学 | 一种单轴旋转惯导系统惯性器件误差补偿方法 |
CN104121928B (zh) * | 2014-05-29 | 2016-09-28 | 湖北航天技术研究院总体设计所 | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 |
CN105321315A (zh) * | 2014-07-30 | 2016-02-10 | 芯讯通无线科技(上海)有限公司 | 飞行器系统及其通信方法 |
CN105606124A (zh) * | 2015-12-21 | 2016-05-25 | 河北汉光重工有限责任公司 | 一种双馈回路陀螺调制方法 |
CN106338266A (zh) * | 2016-08-29 | 2017-01-18 | 孟玲 | 基于二维位置敏感传感器的空间六自由度物体定位系统 |
CN106840195B (zh) * | 2016-12-19 | 2019-01-29 | 中北大学 | 一种旋转式半捷联微惯性测量系统误差抑制方法 |
CN110006453A (zh) * | 2019-04-18 | 2019-07-12 | 哈尔滨工程大学 | 一种基于双轴转位机构的mems自主初始对准方法 |
CN110749338A (zh) * | 2019-10-22 | 2020-02-04 | 中国人民解放军战略支援部队航天工程大学 | 一种惯性测量单元偏轴-旋转复合转位误差标定方法 |
-
2009
- 2009-11-20 CN CN2009100732418A patent/CN101718560B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101718560A (zh) | 2010-06-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101718560B (zh) | 基于单轴四位置转停方案的捷联系统的误差抑制方法 | |
CN101514899B (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN101514900B (zh) | 一种单轴旋转的捷联惯导系统初始对准方法 | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
Sun et al. | MEMS-based rotary strapdown inertial navigation system | |
CN102721417B (zh) | 一种捷联惯性导航系统凝固惯性系粗对准误差抑制方法 | |
CN103090866B (zh) | 一种单轴旋转光纤陀螺捷联惯导系统速度误差抑制方法 | |
CN100541132C (zh) | 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法 | |
CN101793523B (zh) | 一种组合导航和光电探测一体化系统 | |
CN101629826A (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法 | |
CN102788598B (zh) | 基于三轴旋转的光纤捷联惯导系统误差抑制方法 | |
CN101713666B (zh) | 一种基于单轴转停方案的系泊估漂方法 | |
CN104501838B (zh) | 捷联惯导系统初始对准方法 | |
CN102829781B (zh) | 一种旋转式捷联光纤罗经实现的方法 | |
CN103245360A (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN201955092U (zh) | 一种基于地磁辅助的平台式惯性导航装置 | |
CN101571394A (zh) | 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法 | |
CN111102993A (zh) | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 | |
CN103471616A (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN102798399A (zh) | 基于双轴转动方案的捷联惯导系统误差抑制方法 | |
CN102788597B (zh) | 基于空间稳定的旋转捷联惯导系统误差抑制方法 | |
CN102768043B (zh) | 一种无外观测量的调制型捷联系统组合姿态确定方法 | |
CN103090865B (zh) | 一种调制型捷联惯性导航系统姿态误差抑制方法 | |
CN103256943A (zh) | 一种在单轴旋转捷联惯导系统中刻度因数误差的补偿方法 | |
CN103148854A (zh) | 基于单轴正反转动的mems惯导系统姿态测量方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20111116 Termination date: 20171120 |
|
CF01 | Termination of patent right due to non-payment of annual fee |