CN102853833B - 捷联惯性导航***快速阻尼方法 - Google Patents
捷联惯性导航***快速阻尼方法 Download PDFInfo
- Publication number
- CN102853833B CN102853833B CN201210110895.5A CN201210110895A CN102853833B CN 102853833 B CN102853833 B CN 102853833B CN 201210110895 A CN201210110895 A CN 201210110895A CN 102853833 B CN102853833 B CN 102853833B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- navigation system
- speed
- omega
- moment
- 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
Landscapes
- Navigation (AREA)
Abstract
本发明提供的是一种捷联惯性导航***快速阻尼方法。步骤一:捷联惯导***进行预热准备;步骤二:捷联惯导***进行初始对准;步骤三:进行正向姿态矩阵更新;步骤四:进行正向速度更新;步骤五:进行正向位置更新;步骤六:对上述数据完成存储,进行姿态矩阵、速度、位置的重新初值赋值,进行惯导***逆向解算;步骤七:进行逆向姿态矩阵更新;步骤八:进行逆向速度更新;步骤九:进行逆向位置更新;步骤十:重新对姿态矩阵、速度、位置进行初值赋值,并重复步骤三至步骤九。本发明充分利用捷联惯性导航***的“数学平台”多样性的特点,引入可逆算法,最终实现了捷联惯性导航******误差的快速收敛。本发明的方法可用于船用捷联惯导***的导航误差抑制领域。
Description
技术领域
本发明涉及的是一种捷联惯性导航***导航误差快速抑制方法。
背景技术
船舶捷联惯性导航***要求在长时间工作条件下能够提供高精度的导航信息。通过提高元器件的精度、对元器件误差参数精确标定以及对初始对准方法的改进能够提高惯导***的精度,而如何在船舶捷联惯性导航***使用过程中充分利用现有技术条件,采用高效的误差抑制手段,使***应具有的精度最大限度地发挥,是惯导方案需要深入研究的课题。目前捷联惯性导航***中常采用引入阻尼的方式,来对振荡性的***误差进行抑制。对于方位阻尼来说,要阻尼地球周期振荡误差分量,由于地球周期是24小时,所以阻尼过程时间要很长。通常需要一个半周期才能阻尼下来(即需要36小时)。要想阻尼的快,阻尼系数ξ就要选大,而阻尼系数大,***对船舶加速度的响应就大。由于阻尼过程时间长,故一般情况下,惯导***不能工作在方位阻尼工作状态。
发明内容
本发明的目的在于提供一种能够实现捷联惯性导航******误差的快速收敛的捷联惯性导航***快速阻尼方法。
本发明的目的是这样实现的:
步骤一:捷联惯导***进行预热准备;
步骤二:捷联惯导***进行初始对准;
步骤三:进行正向姿态矩阵更新;
步骤四:进行正向速度更新;
步骤五:进行正向位置更新;
步骤六:对步骤三至步骤五的数据完成存储,进行姿态矩阵、速度、位置的重新初值赋值,进行惯导***逆向解算;
步骤七:进行逆向姿态矩阵更新;
步骤八:进行逆向速度更新;
步骤九:进行逆向位置更新;
步骤十:重新对姿态矩阵、速度、位置进行初值赋值,并重复步骤三至步骤九。
本发明利用捷联***数学平台的多样性,对快速阻尼算法进行研究。假设导航计算机存储容量足够大并且计算能力足够强,则导航计算机可以对SINS的采样数据进行存储,并应用不同的算法对已存储的数据进行反复计算,解算出当前时刻最优的导航结果。而这一特点在平台惯导***中是不可能实现的,因为一旦对平台施加了某种控制后,就难以使平台恢复到控制前的状态以便重新实施另外一种控制算法,若将SINS存储的采样数据当作一组时间序列看待,正常情况下对该序列按时间先后从前往后进行分析,达到实现***阻尼的目的。如果简单地按时间直接将采样数据序列进行分段分配,则越是在前期阶段中被利用的数据信息越少,若在后期阶段中将前期阶段数据丢弃不再利用将造成信息浪费,因此在后期阶段中还应当反过来重新挖掘前期阶段的数据信息,如此反复利用数据,必然能够增加可用信息量,有利于缩短***阻尼时间。
为了解决传统的捷联***方位阻尼收敛时间长、速度慢的缺点,本发明充分利用捷联惯性导航***的“数学平台”多样性的特点,引入可逆算法,提出了一种快速阻尼方案,最终实现了捷联惯性导航******误差的快速收敛。本发明的方法可用于船用捷联惯导***的导航误差抑制领域。
本发明的优点主要体现在:
一、本发明在没有使用任何外部辅助信息的基础上,抑制了导航信息的误差,提高了捷联惯性导航***的精度;
二、本发明充分利用捷联惯性导航***的“数学平台”的多样性,提高了***阻尼的收敛速度,大大缩短了收敛时间。
三、本发明在没有增大阻尼系数的条件下,缩短了阻尼时间,因此本方案有着较强的运动适应性。
附图说明
图1为本发明的流程图;
图2为本发明的原理图。
具体实施方式
下面举例对本发明做更详细的描述:
步骤一:捷联惯导***的预热准备,预热时间约为2个小时;
步骤二:捷联惯导***的初始对准;
步骤三:进行正向姿态矩阵更新;
正向姿态矩阵更新计算时,采用的算法模型为:
式中:
为k、k-1时刻的姿态矩阵;为k时刻陀螺角速度;ΔT为陀螺和加速度计的采样周期;为k-1时刻地理坐标系下东向和北向的速度;HN、HE为惯导***北向和东向水平回路阻尼网络;Y为方位阻尼网络;为k-1时刻的纬度;ωie为地球转速;R为地球半径。是载体系相对导航系的陀螺角速度;是计算坐标系相对于导航坐标系的陀螺角速度在K-1时刻的投影;是载体北向速度在导航坐标系中k-1时刻的投影;是载体东向速度在导航坐标系中k-1时刻的投影。
步骤四:进行正向速度更新;
正向速度更新计算时,采用的算法模型为:
式中:
gn=[0,0,-g]T,
为k、k-1时刻地理坐标系下的速度;分别为k时刻地球转速和地理坐标系相对地球的转速在地理坐标系的投影;为k时刻载体坐标系下的加速度;g为重力加速度。是载体东向速度在导航坐标系中k时刻的投影;是载体北向速度在导航坐标系中k时刻的投影。
步骤五:进行正向位置更新;
正向位置更新计算时,采用的算法模型为:
式中:λk、λk-1为k、k-1时刻的经度。
步骤六:对上述数据完成存储,进行姿态矩阵、速度、位置的重新初值赋值,进行惯导***逆向解算;
假设计算机存储了从离散化的t0时刻至tm时刻的惯导解算值,这时惯导***从A点导航至B点,则为了使软件算法从B点逆向导航至A点,由式(1)、(3)、(5)移项并稍作变化,整理得逆向捷联惯导算法为:
式中:
令p=m-k+1,若记 (j=0,1,2...m),则通过记号和下标转换,式(6)、(7)、(8)、(9)可写成:
通过对比式(1)、(3)、(5)和式(10)、(11)、(12),发现它们在算法表示形式上是完全一致的。从上述分析过程中可以看出,只要将正向算法中的陀螺采样和地球自转角速率符号取反,并设置逆向导航算法的初值为 对采样数据作逆向处理,即可实现从tm时刻(B点)至t0时刻(A点)的逆向导航解算。
步骤七:进行逆向姿态矩阵更新;
步骤八:进行逆向速度更新;
步骤九:进行逆向位置更新;
步骤十:重新对姿态矩阵、速度、位置进行初值赋值,并重复步骤三至步骤九。
步骤七-八中,逆向姿态矩阵更新计算时,采用的模型为式(10);逆向速度更新计算时,采用的模型为式(11);逆向位置更新计算时,采用的模型为式(12)。
Claims (4)
1.一种捷联惯性导航***快速阻尼方法,其特征是:
步骤一:捷联惯导***进行预热准备;
步骤二:捷联惯导***进行初始对准;
步骤三:进行正向姿态矩阵更新;
步骤四:进行正向速度更新;
步骤五:进行正向位置更新;
步骤六:对步骤三至步骤五的数据完成存储,进行姿态矩阵、速度、位置的重新初值赋值,进行惯导***逆向解算;
步骤七:进行逆向姿态矩阵更新;
步骤八:进行逆向速度更新;
步骤九:进行逆向位置更新;
步骤十:重新对姿态矩阵、速度、位置进行初值赋值,并重复步骤三至步骤九;
所述正向姿态矩阵更新,采用如下模型:
其中:
k=1,2,3...;
为k、k-1时刻的姿态矩阵;为k时刻陀螺角速度;ΔT为陀螺和加速度计的采样周期;为k-1时刻地理坐标系下东向和北向的速度;HN、HE为惯导***北向和东向水平回路阻尼网络;Y为方位阻尼网络;为k时刻的纬度;ωie为地球转速;R为地球半径。
2.根据权利要求1所述的捷联惯性导航***快速阻尼方法,其特征是所述正向速度更新,采用如下模型:
其中:
gn=[0,0,-g]T,
k=1,2,3...;
为k、k-1时刻地理坐标系下的速度;分别为k时刻地球转速和地理坐标系相对地球的转速在地理坐标系的投影;为k时刻载体坐标系下的加速度;g为重力加速度。
3.根据权利要求2所述的捷联惯性导航***快速阻尼方法,其特征是所述正向位置更新,采用如下模型:
其中:λk、λk-1为k、k-1时刻的经度。
4.根据权利要求3所述的捷联惯性导航***快速阻尼方法,其特征是所述进行惯导***逆向解算的方法为:将正向姿态矩阵更新、速度更新、位置更新模型中的陀螺采样和地球自转角速率符号取反,并设置逆向导航算法的初值为对采样数据作逆向处理,实现从tm时刻至t0时刻的逆向导航解算。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210110895.5A CN102853833B (zh) | 2012-04-16 | 2012-04-16 | 捷联惯性导航***快速阻尼方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210110895.5A CN102853833B (zh) | 2012-04-16 | 2012-04-16 | 捷联惯性导航***快速阻尼方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102853833A CN102853833A (zh) | 2013-01-02 |
CN102853833B true CN102853833B (zh) | 2014-12-17 |
Family
ID=47400634
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210110895.5A Active CN102853833B (zh) | 2012-04-16 | 2012-04-16 | 捷联惯性导航***快速阻尼方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102853833B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102121829B (zh) | 2010-08-09 | 2013-06-12 | 汪滔 | 一种微型惯性测量*** |
CN103557863B (zh) * | 2013-10-15 | 2016-05-04 | 哈尔滨工程大学 | 水下潜器的阻尼方法 |
CN104713571B (zh) * | 2013-12-11 | 2018-02-27 | 中国航空工业第六一八研究所 | 一种潜艇惯性导航***航行应急启动方法 |
CN103900568B (zh) * | 2014-03-08 | 2016-06-29 | 哈尔滨工程大学 | 一种改进的捷联惯性导航***快速阻尼方法 |
WO2015161517A1 (en) * | 2014-04-25 | 2015-10-29 | SZ DJI Technology Co., Ltd. | Inertial sensing device |
CN106482749B (zh) * | 2016-12-07 | 2019-10-22 | 西北工业大学 | 基于逆向导航算法的捷联惯导与转速计组合对准方法 |
CN108759842A (zh) * | 2018-05-07 | 2018-11-06 | 哈尔滨工程大学 | 基于卡尔曼滤波的旋转式惯性导航***外水平阻尼方法 |
CN110806220B (zh) * | 2019-11-23 | 2022-03-22 | 中国船舶重工集团公司第七一七研究所 | 一种惯导***初始对准方法及装置 |
CN111024129A (zh) * | 2019-12-30 | 2020-04-17 | 重庆华渝电气集团有限公司 | 一种基于逆向解算编排的快速对准方法 |
CN112697166B (zh) * | 2020-11-04 | 2023-06-06 | 河北汉光重工有限责任公司 | 一种运动状态下的捷联惯导***自对准方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6032099A (en) * | 1996-11-02 | 2000-02-29 | Fernandez; Manuel | Automatic correction of key error sources in an inertial navigator |
TW577975B (en) * | 2000-07-25 | 2004-03-01 | American Gnc Corp | Core inertial measurement unit |
CN101187562A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 船用光纤陀螺捷联***初始姿态确定方法 |
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航***阻尼方法 |
-
2012
- 2012-04-16 CN CN201210110895.5A patent/CN102853833B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6032099A (en) * | 1996-11-02 | 2000-02-29 | Fernandez; Manuel | Automatic correction of key error sources in an inertial navigator |
TW577975B (en) * | 2000-07-25 | 2004-03-01 | American Gnc Corp | Core inertial measurement unit |
CN101187562A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 船用光纤陀螺捷联***初始姿态确定方法 |
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航***阻尼方法 |
Non-Patent Citations (2)
Title |
---|
《惯性***的零速校正技术研究》;奔粤阳等;《***仿真学报》;20080930;第20卷(第17期);4639-4642 * |
《阻尼参数连续可调的惯导水平内阻尼方法》;覃方君等;《中国惯性技术学报》;20110630;第19卷(第3期);290-292,301 * |
Also Published As
Publication number | Publication date |
---|---|
CN102853833A (zh) | 2013-01-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102853833B (zh) | 捷联惯性导航***快速阻尼方法 | |
CN111857152B (zh) | 用于生成车辆控制信息的方法和装置 | |
CN103869379B (zh) | 基于遗传算法优化改进bp神经网络的磁力计校正方法 | |
CN102778230B (zh) | 一种人工物理优化粒子滤波的重力梯度辅助定位方法 | |
CN110702143B (zh) | 基于李群描述的sins捷联惯性导航***动基座快速初始对准方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导***大方位失准角初始对准方法 | |
CN104655131A (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN110806220B (zh) | 一种惯导***初始对准方法及装置 | |
CN111735474B (zh) | 一种基于数据回溯的动基座罗经对准方法 | |
WO2021110055A1 (zh) | 一种用于最优估计精对准的严格逆向导航方法 | |
CN103454662B (zh) | 一种基于ckf的sins/北斗/dvl组合对准方法 | |
CN102928858A (zh) | 基于改进扩展卡尔曼滤波的gnss单点动态定位方法 | |
CN105352502A (zh) | 一种微惯性航姿参考***的姿态获取方法 | |
CN115855049B (zh) | 基于粒子群优化鲁棒滤波的sins/dvl导航方法 | |
CN103674059A (zh) | 一种基于外测速度信息的sins水平姿态误差修正方法 | |
CN109506638B (zh) | 一种补偿陀螺标度因数对旋转调制罗经方位对准影响方法 | |
CN103364842B (zh) | 一种捷联式航空重力仪误差分离方法 | |
CN103123487A (zh) | 一种航天器姿态确定方法 | |
CN108205146B (zh) | 一种基于地面接收机的导航卫星快速寻星定轨方法 | |
CN105300407B (zh) | 一种用于单轴调制激光陀螺惯导***的海上动态启动方法 | |
CN104121930A (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN112729332B (zh) | 一种基于旋转调制的对准方法 | |
CN113847915A (zh) | 一种捷联惯导/多普勒组合导航***的导航方法 | |
CN112229421B (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |