CN102109358A - 一种船用激光陀螺惯性导航系统位置校正方法 - Google Patents
一种船用激光陀螺惯性导航系统位置校正方法 Download PDFInfo
- Publication number
- CN102109358A CN102109358A CN 201010608911 CN201010608911A CN102109358A CN 102109358 A CN102109358 A CN 102109358A CN 201010608911 CN201010608911 CN 201010608911 CN 201010608911 A CN201010608911 A CN 201010608911A CN 102109358 A CN102109358 A CN 102109358A
- Authority
- CN
- China
- Prior art keywords
- omega
- overbar
- error
- inertial navigation
- delta
- 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
Images
Landscapes
- Navigation (AREA)
Abstract
一种船用激光陀螺惯性导航系统位置校正方法,将长时间导航时完整惯导误差模型在校正时间内进行简化,得到短时间内简化惯导误差模型;利用三次间断获得的外部位置、速度参考信息,得到当前时刻惯导系统的位置误差、速度误差;计算当前时刻惯导系统数学平台偏角的影响并从三次获得的外部位置、速度参考信息中扣除,得到由等效陀螺漂移引起的惯导系统误差;若获得外部参考信息时刻为24h整倍数时,则根据无舒拉振荡条件下由陀螺漂移造成的惯导系统误差方程计算导致惯导误差发散的等效地轴方向陀螺漂移;利用估计得到的惯导系统速度误差、位置误差、平台偏角误差及陀螺漂移对系统进行修正,提高导航精度。
Description
技术领域
本发明涉及一种新型、高效、实用的船用激光陀螺惯性导航系统位置校正方法,可应用于其它类型的水面/水下运载体的惯性导航系统中,属于惯性导航领域。
技术背景
惯性导航系统具有全自主、高隐蔽性、高带宽、连续输出等特点,在国防上具有战略意义,是航空、航天、航海等领域中最重要的设备之一。
船用应用环境中,常要求惯导系统连续工作几天甚至更长时间,由于陀螺漂移等原因会使惯导系统逐渐失去导航功能。提高惯导系统长时间导航精度可采取两方面措施:(1)提高惯性器件精度,然而提高惯性器件精度往往需要付出较大的代价,成本也将大大提高;(2)采取适当的系统级算法,在有外部参考信息时对系统进行校正(可用外部参考信息一般为位置和速度),将惯导误差限制在一定的范围之内。传统的位置校正算法有两种类型:一种是在有参考信息时只校正位置和速度,这种方法只需一次有效的外部参考信息即可实现,因此简单方便,然而却不能抑制惯导误差的舒拉振荡(导航误差的一种周期性振荡),也不能从根本上解决陀螺漂移带来的惯导误差发散问题;另一种方案基于陀螺漂移为常值的假设,利用惯导误差模型拟合出平台偏角和陀螺漂移,并修正位置和速度。然而陀螺漂移在长时间导航时不会保持常值,而是在不断地发生变化,因此拟合出的平台偏角有较大误差。
发明内容
本发明的技术解决问题是:克服现有船用惯导系统位置校正算法在处理变化的陀螺漂移等问题上的弊端,能更准确地拟合出舒拉振荡的参数以及导致导航误差发散的地轴方向陀螺漂移,具有准确、高效、实用、易于实现等特点。
本发明的技术解决方案是:一种船用激光陀螺惯性导航系统位置校正方法,其实现步骤如下:
(1)将长时间导航时完整惯导误差模型在校正时间内进行简化,得到短时间内简化惯导误差模型;
(2)根据步骤(1)所建立的短时间内惯导误差模型短时间内简化惯导误差模型,利用三次间断获得的外部位置、速度参考信息,得到当前时刻惯导系统的位置误差、速度误差,并计算出惯导系统的数学平台偏角;
(3)在完整惯导误差模型中,将位置误差、速度误差和数学平台偏角造成的影响扣除,并忽略陀螺漂移造成的舒拉振荡项,得到无舒拉振荡条件下由陀螺漂移造成的惯导系统误差方程;
(4)将步骤(2)计算出数学平台偏角的影响从三次获得的外部位置、速度参考信息中扣除,得到由等效陀螺漂移引起的惯导系统误差;
(5)根据步骤(3)所建立的无舒拉振荡条件下由陀螺漂移造成的惯导系统误差方程及步骤(4)得到由等效陀螺漂移引起的惯导系统误差,若获得外部参考信息时刻为24h整倍数时,则计算导致惯导误差发散的等效地轴方向陀螺漂移;
(6)根据步骤(2)及(5)估计得到的惯导系统速度误差、位置误差、平台偏角误差及陀螺漂移对系统进行修正,提高导航精度。
本发明的原理是:通过运载体在1h内间隔3次获取外部参考位置、速度信息,结合惯导系统短时间误差模型,可以拟合出当前时刻惯导系统舒拉振荡系数,若校正时刻发生在24h整倍数附近,则可根据误差模型计算导致系统导航误差发散的等效地轴方向漂移。
本发明与现有技术相比的优点在于:
(1)传统的位置校正算法基于陀螺漂移为常值的假设,然而陀螺漂移在长时间导航时不会保持常值,而是在不断地发生变化,因此传统的位置校正算法拟合出的平台偏角和陀螺漂移有较大误差。本发明建立了校正时刻一段时间内惯导的误差模型,避免了整个过程漂移变化带来的影响,提高了误差系数的估计精度。
(2)本发明在修正陀螺漂移时,只针对导致导航误差发散的地轴方向陀螺漂移进行,具有准确、高效、实用、易于实现等特点。
附图说明
图1为本发明所指的惯性导航系统位置校正方法流程图;
图2为本发明实施例中不含位置校正时的位置误差曲线;
图3为本发明实施例中不含位置校正时的速度误差曲线;
图4为本发明实施例中不含位置校正时的姿态误差曲线;
图5为本发明实施例中进行位置校正时的位置误差曲线;
图6为本发明实施例中进行位置校正时的速度误差曲线;
图7为本发明实施例中进行位置校正时的姿态误差曲线。
具体实施方式
下面以某型激光陀螺惯导系统海上试验位置校正过程为例来阐述本发明的具体实施过程。
1、将长时间导航时完整惯导误差模型在校正时间内进行简化,得到短时间内简化惯导误差模型如下:
ΔvE=B1+C1t+D1cosωst+E1sinωst (20)
ΔvN=B2+C2t+D2cosωst+E2sinωst (21)
上式(20)~(23)中,ωs为舒拉振荡角速度,A1~E1,A2~E2为分别为东向北向速度位置误差系数;
2、接收到三次外部参考信息得到惯导速度位置误差分别表示为:ΔvEi,ΔvNi,ΔSEi,ΔSNi(i=1,2,3),接收时刻分别为
若令
则有东向通道:
ZkE=HkXkE (24)
北向通道:
ZkN=HkXkN (25)
可得XkE、XkN的最小二乘解为:
从而得到B1,C1,D1,E1和B2,C2,D2,E2。
反推出:
用φE,φN分别表示东向、北向平台偏角。则有:
3、建立无舒拉振荡惯导系统误差模型。由于惯导误差中,只有经度误差随时间发散,因此,此处只建立经度误差方程:
其中,εE、εN、εu分别为东、北、天向陀螺漂移。
若只考虑导致经度发散的误差项,定义地轴方向陀螺漂移:
则惯导东向位置误差表达式为:
当t为24h的整数倍时,上式表示为:
4、从三次外部参考信息中扣除由于舒拉振荡引起的位置误差和速度误差,舒拉振荡的参数由式(26)和(27)给出。
5、位置校正时,得到扣除舒拉振荡项后第三个点的位置误差ΔS′E,则有:
可计算出等效地轴方向陀螺漂移为:
6、误差修正。
对漂移的修正采用输出校正方式。具体修正公式如下:
式(38)中,λ为惯导解算出的经度,λ′为输出校正的经度。
对数学平台偏角的修正:
对位置速度误差的修正:
λ′I=λI-Δλ (40)
V′I=VI-ΔV (42)
如图2所示,未经校正的惯导系统82h导航位置误差曲线,纬度误差包含舒拉振荡及地球自转周期振荡,最大误差为6000m,且振荡幅度随时间有增大的趋势,而经度误差随时间发散,82h最大达到近12000m,且随导航时间的增长,还会进一步增大;
如图3所示,未经校正的惯导系统82h导航速度误差曲线,可以看出,若不经校正,则最大速度误差可达5m/s,且误差的幅度随时间增长还会进一步增大;
如图4所示,未经校正的惯导系统82h导航姿态误差曲线,可以看出,若不经校正,姿态最大误差可达120”,航向误差最大可达200”,误差的振荡受地球自转周期的调制,幅度随时间进一步增大;
如图5所示,利用本发明提出的校正算法在第48h附近校正以后的位置误差曲线,可以看出,校正以后,位置误差的振荡幅度、发散趋势均得到了很好的抑制,校正之后近40h之内,导航最大位置误差都在ln mile左右,达到了很好的校正效果;
如图6所示,利用本发明提出的校正算法在第48h附近校正以后的速度误差曲线,可以看出,校正以后的速度误差振荡幅度大大地减小了;
如图7所示,利用本发明提出的校正算法在第48h附近校正以后的姿态误差曲线,可以看出,校正以后的姿态误差也被极大地抑制,达到了校正的目的,取得了较好效果;
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
最后所应说明的是:以上实施实例仅用以说明而非限制本发明的技术方案,所有的不脱离本发明的精神和范围的修改或局部替换,均应涵盖在本发明的权利要求范围当中。
Claims (5)
1.一种船用激光陀螺惯性导航系统位置校正方法,其特征在于实现步骤如下:
(1)将长时间导航时完整惯导误差模型在校正时间内进行简化,得到短时间内简化惯导误差模型;
(2)根据步骤(1)所建立的短时间内简化惯导误差模型,利用三次间断获得的外部位置、速度参考信息,得到当前时刻惯导系统的位置误差、速度误差,并计算出惯导系统的数学平台偏角;
(3)在完整惯导误差模型中,将位置误差、速度误差和数学平台偏角造成的影响扣除,并忽略陀螺漂移造成的舒拉振荡项,得到无舒拉振荡条件下由陀螺漂移造成的惯导系统误差方程;
(4)将步骤(2)计算出数学平台偏角的影响从三次获得的外部位置、速度参考信息中扣除,得到由等效陀螺漂移引起的惯导系统误差;
(5)根据步骤(3)所建立的无舒拉振荡条件下由陀螺漂移造成的惯导系统误差方程及步骤(4)得到由等效陀螺漂移引起的惯导系统误差,若获得外部参考信息时刻为24h整倍数时,则计算导致惯导误差发散的等效地轴方向陀螺漂移;
(6)根据步骤(2)及(5)估计得到的惯导系统速度误差、位置误差、平台偏角误差及陀螺漂移对系统进行修正,提高导航精度。
2.根据权利要求1所述的全新船用激光陀螺惯性导航系统位置校正方法,其特征在于:所述步骤(1)中的短时间内简化惯导系统误差模型如下:
ΔvE=B1+C1t+D1cosωst+E1sinωst (1)
ΔvN=B2+C2t+D2cosωst+E2sinωst (2)
5.根据权利要求1所述的全新船用激光陀螺惯性导航系统位置校正方法,其特征在于:所述步骤(6)对漂移的修正采用输出校正方式,具体修正公式如下:
式(19)中,λ为惯导解算出的经度,λ′为输出校正的经度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010106089114A CN102109358B (zh) | 2010-12-17 | 2010-12-17 | 一种船用激光陀螺惯性导航系统位置校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010106089114A CN102109358B (zh) | 2010-12-17 | 2010-12-17 | 一种船用激光陀螺惯性导航系统位置校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102109358A true CN102109358A (zh) | 2011-06-29 |
CN102109358B CN102109358B (zh) | 2012-05-23 |
Family
ID=44173578
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010106089114A Active CN102109358B (zh) | 2010-12-17 | 2010-12-17 | 一种船用激光陀螺惯性导航系统位置校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102109358B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102721425A (zh) * | 2012-05-23 | 2012-10-10 | 北京红旗胜利科技发展有限责任公司 | 一种导航系统中修正航向的方法及装置 |
CN103591955A (zh) * | 2013-11-21 | 2014-02-19 | 西安中科光电精密工程有限公司 | 组合导航系统 |
CN116046027A (zh) * | 2023-03-31 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 三轴旋转式惯导位置误差无源自主校准方法及系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101183004A (zh) * | 2007-12-03 | 2008-05-21 | 哈尔滨工程大学 | 一种在线实时消除光纤陀螺捷联惯导系统振荡误差的方法 |
CN101419080A (zh) * | 2008-06-13 | 2009-04-29 | 哈尔滨工程大学 | 微型捷联惯性测量系统的零速校正方法 |
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航系统阻尼方法 |
-
2010
- 2010-12-17 CN CN2010106089114A patent/CN102109358B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101183004A (zh) * | 2007-12-03 | 2008-05-21 | 哈尔滨工程大学 | 一种在线实时消除光纤陀螺捷联惯导系统振荡误差的方法 |
CN101419080A (zh) * | 2008-06-13 | 2009-04-29 | 哈尔滨工程大学 | 微型捷联惯性测量系统的零速校正方法 |
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航系统阻尼方法 |
Non-Patent Citations (3)
Title |
---|
《北京航空航天大学学报》 20090430 王玮等 伪卫星/惯性组合导航的非线性补偿 全文 1-5 第35卷, 第4期 2 * |
《南京航空航天大学学报》 20050630 杜亚玲等 捷联惯性航姿系统中的模糊内阻尼算法研究 全文 1-5 第37卷, 第3期 2 * |
《计算机仿真》 20081130 徐仕会等 惯性导航系统扰动基座对准仿真研究 全文 1-5 第25卷, 第11期 2 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102721425A (zh) * | 2012-05-23 | 2012-10-10 | 北京红旗胜利科技发展有限责任公司 | 一种导航系统中修正航向的方法及装置 |
CN102721425B (zh) * | 2012-05-23 | 2015-09-02 | 北京红旗胜利科技发展有限责任公司 | 一种导航系统中修正航向的方法及装置 |
CN103591955A (zh) * | 2013-11-21 | 2014-02-19 | 西安中科光电精密工程有限公司 | 组合导航系统 |
CN103591955B (zh) * | 2013-11-21 | 2016-03-30 | 西安中科光电精密工程有限公司 | 组合导航系统 |
CN116046027A (zh) * | 2023-03-31 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 三轴旋转式惯导位置误差无源自主校准方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN102109358B (zh) | 2012-05-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN103630137B (zh) | 一种用于导航系统的姿态及航向角的校正方法 | |
CN110487301A (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
CN104655131B (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN103471616B (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN101881619B (zh) | 基于姿态测量的船用捷联惯导与天文定位方法 | |
CN101706284B (zh) | 提高船用光纤陀螺捷联惯导系统定位精度的方法 | |
CN104344836B (zh) | 一种基于姿态观测的冗余惯导系统光纤陀螺系统级标定方法 | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法 | |
CN101713666B (zh) | 一种基于单轴转停方案的系泊估漂方法 | |
CN104075715A (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
CN103278163A (zh) | 一种基于非线性模型的sins/dvl组合导航方法 | |
CN103076026B (zh) | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 | |
CN102168978B (zh) | 一种船用惯性导航系统摇摆基座开环对准方法 | |
CN103398713A (zh) | 一种星敏感器/光纤惯性设备量测数据同步方法 | |
CN105891863A (zh) | 一种基于高度约束的扩展卡尔曼滤波定位方法 | |
CN102654406A (zh) | 基于非线性预测滤波与求容积卡尔曼滤波相结合的动基座初始对准方法 | |
CN103292812A (zh) | 一种微惯性sins/gps组合导航系统的自适应滤波方法 | |
CN105091907A (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN103674064B (zh) | 捷联惯性导航系统的初始标定方法 | |
CN103743413A (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
CN104776847B (zh) | 一种适用于水下导航系统单点估计陀螺漂移的方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN103674059A (zh) | 一种基于外测速度信息的sins水平姿态误差修正方法 |
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 |