CN114279462B - 一种惯导周期性误差自主估计与预测方法 - Google Patents
一种惯导周期性误差自主估计与预测方法 Download PDFInfo
- Publication number
- CN114279462B CN114279462B CN202111404564.8A CN202111404564A CN114279462B CN 114279462 B CN114279462 B CN 114279462B CN 202111404564 A CN202111404564 A CN 202111404564A CN 114279462 B CN114279462 B CN 114279462B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- sets
- earth
- errors
- latitude
- 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
Images
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种惯导周期性误差自主估计与预测方法,其技术特点是:观测两套惯导纬度和经度误差差值,提取误差差值中地球周期振荡项幅值和相位;获取两套惯导各自纬、经度误差中地球周期振荡项幅值和相位,实现惯导纬度、经度误差中地球周期振荡项的估计;根据惯导北速、东速误差中地球周期振荡项实现未来一段时间惯导纬度、经度误差中地球周期振荡项的预测。本发明大大简化了求解难度,其预测值可用于惯导位置输出预先补偿,将显著提升惯导导航信息品质,可适用于深远海水下卫导拒止环境,以完全自主的方式提升惯导长时导航精度。
Description
技术领域
本发明属于惯导技术领域,涉及水下自主导航***,尤其是一种惯导周期性误差自主估计与预测方法。
背景技术
随着各类作战/作业水下平台的发展和崛起,对水下导航提出了更高的要求。目前通过惯导与多普勒声纳组合,可以解决区域内高精度导航问题,但无法满足深远海航行时长航时高精度导航需求。由于卫星导航、天文导航等多种导航手段水下应用受限,水声导航要求提前布设水下声学信标,惯性导航仍是水下长时高精度导航的主要手段。对于阻尼惯性导航***,地球周期振荡误差是惯导位置误差波动的主要原因,严重影响惯导导航信息质量。
发明内容
本发明的目的在于克服现有技术的不足,提供一种惯导周期性误差自主估计与预测方法,克服了地球周期振荡误差对惯导位置误差波动的影响,提高了惯导导航信息品质。
本发明解决现有的技术问题是采取以下技术方案实现的:
一种惯导周期性误差自主估计与预测方法,包括以下步骤:
步骤1、以多普勒声纳北速为基准观测2套惯导北速误差,提取2套惯导北速误差中地球周期振荡项相位;观测2套惯导之间北速、东速差值,提取2套惯导北速、东速差值中地球周期振荡项幅值和相位;观测2套惯导之间纬度差值和经度差值,提取差值中地球周期振荡项幅值和相位;
步骤2、根据步骤1获得的相位信息将2套惯导北速、东速、纬度、经度差值中地球周期振荡项幅值分解,获得2套惯导各自北速、东速、纬度、经度误差中地球周期振荡项幅值;进一步获取2套惯导各自纬度、经度误差中地球周期振荡项相位,实现当前t时刻惯导纬度、经度误差中地球周期振荡项的估计;
步骤3、根据惯导北速、东速误差中地球周期振荡项信息实现未来一段时间惯导纬度、经度误差中地球周期振荡项的预测。
而且,所述步骤1的具体实现方法为:设2套惯导北速为v1、v2,东速v′1、v′2,多普勒声纳北速为vd,以多普勒声纳北速为基准观测2套惯导北速误差Ev1d=v1-vd、Ev2d=v2-vd;2套惯导北速差值为Ev21=v2-v1,东速差值为E′v21=v′2-v′1;读取Ev1d、Ev2d、Ev21、E′v21信号中距离当前时间最近的地球周期振荡峰值对应时间,分别记为t1d、t2d、t21、t′21,则Ev1d、Ev2d、Ev21、E′v21中地球周期振荡项相位为: 读取Ev21、E′v21中地球周期振荡项幅值Av21、A′v21,T为地球周期;2套惯导纬度输出为lat1、lat2,提取2套惯导纬度差值Elat21=lat2-lat1中地球周期振荡项幅值记为A21,相位记为/>2套惯导经度输出为lon1、lon2,提取2套惯导经度差值Elon21=lon2-lon1中地球周期振荡项幅值A′21,相位/>
而且,所述步骤2的具体实现方法为:
(1)通过构建一族三角形求解2套惯导各自北速误差中地球周期振荡幅值Av1、Av2,东速误差中地球周期振荡幅值A′v1、A′v2,纬度误差中地球周期振荡幅值A1、A2,经度误差中地球周期振荡项幅值A′1、A′2;构建一族三角形求解步骤:过点A作直线b,b绕A逆时针旋转度得到直线a,b绕A逆时针旋转/>得到直线c;在直线b上画出与A距离为Av21、A′v21、A21、A′21的点V、V1、P、P1,过V、V1、P、P1作c的平行线与a交于点W、W1、Q、Q1,量取线段WA、WV、W1A、W1V1、QA、QP、Q1A、Q1P1长度即为Av1、Av2、A′v1、A′v2、A1、A2、A′1、A′2;
而且,所述步骤3的具体实现方法为:
(1)根据2套惯导各自北速误差中地球周期振荡项预测未来t+Δt时刻2套惯导纬度误差地球周期振荡项值分别为:
(2)根据2套惯导各自东速误差中地球周期振荡项预测未来t+Δt时刻2套惯导经度误差地球周期振荡项预测值分别为:
本发明的优点和积极效果是:
本发明基于观测的相位信息,从2套惯导位置、速度差值中分离出2套惯导各自位置、速度误差中地球周期振荡项,并通过构建一族三角形求解“将2套惯导北速、东速、纬度、经度差值中地球周期振荡项幅值分解为2套惯导各自北速、东速、纬度、经度误差中地球周期振荡幅值”的问题,大大简化了求解难度;利用速度的超前特性预测未来一段时间惯导经纬度误差的地球周期振荡项,其预测值可用于惯导位置输出的预先补偿,将显著提升惯导导航信息品质;本发明适用于深远海水下卫导拒止环境,以完全自主方式提升惯导长时导航精度。
附图说明
图1为本发明的2套惯导北速、东速、纬度、经度差值地球周期振荡幅值分解为2套惯导各自北速、东速、纬度、经度误差中地球周期振荡幅值的示意图。
具体实施方式
以下结合附图对本发明实施例做进一步详述。
本发明是在由2套高精度惯导和多普勒声纳组成的水下自主导航***上实现的。***中的高精度惯导工作于阻尼状态,基于设备间的互观测信息估计和预测惯导经度、纬度误差中的地球周期振荡项。
基于上述说明,本发明提出一种惯导周期性误差自主估计与预测方法,包括以下步骤:
步骤1、以多普勒声纳北速为基准观测2套惯导北速误差,提取2套惯导北速误差中地球周期振荡项相位;观测2套惯导之间北速、东速差值,提取2套惯导北速、东速差值中地球周期振荡项幅值和相位;观测2套惯导之间纬度差值和经度差值,提取差值中地球周期振荡项幅值和相位。
在本步骤中,设2套惯导北速为v1、v2,东速v′1、v′2,多普勒声纳北速为vd,以多普勒声纳北速为基准观测2套惯导北速误差Ev1d=v1-vd、Ev2d=v2-vd;2套惯导北速差值为Ev21=v2-v1,东速差值为E′v21=v′2-v′1;读取Ev1d、Ev2d、Ev21、E′v21信号中距离当前时间最近的地球周期振荡峰值对应时间,分别记为t1d、t2d、t21、t′21,则Ev1d、Ev2d、Ev21、E′v21中地球周期振荡项相位为:读取Ev21、E′v21中地球周期振荡项幅值Av21、A′v21,T为地球周期。
2套惯导纬度输出为lat1、lat2,提取2套惯导纬度差值Elat21=lat2-lat1中地球周期振荡项幅值记为A21,相位记为2套惯导经度输出为lon1、lon2,提取2套惯导经度差值Elon21=lon2-lon1中地球周期振荡项幅值A′21,相位/>
步骤2、根据步骤1获得的相位信息将2套惯导北速、东速、纬度、经度差值中地球周期振荡项幅值分解,获得2套惯导各自北速、东速、纬度、经度误差中地球周期振荡项幅值;进一步获取2套惯导各自纬度、经度误差中地球周期振荡项相位,实现当前t时刻惯导纬度、经度误差中地球周期振荡项的估计。
本步骤具体实现方法为:
(1)通过构建一族三角形求解2套惯导各自北速误差中地球周期振荡幅值Av1、Av2,东速误差中地球周期振荡幅值A′v1、A′v2,纬度误差中地球周期振荡幅值A1、A2,经度误差中地球周期振荡项幅值A′1、A′2。构建一族三角形求解步骤:过点A作直线b,b绕A逆时针旋转度得到直线a,b绕A逆时针旋转/>得到直线c;在直线b上画出与A距离为Av21、A′v21、A21、A′21的点V、V1、P、P1,过V、V1、P、P1作c的平行线与a交于点W、W1、Q、Q1,量取线段WA、WV、W1A、W1V1、QA、QP、Q1A、Q1P1长度即为Av1、Av2、A′v1、A′v2、A1、A2、A′1、A′2。构建一族三角形求解如图1所示。
步骤3、根据惯导北速、东速误差中地球周期振荡项信息实现未来一段时间惯导纬度、经度误差中地球周期振荡项的预测。
在本步骤具体实现方法为:
(1)根据2套惯导各自北速误差中地球周期振荡项预测未来t+Δt时刻2套惯导纬度误差地球周期振荡项值分别为:
(2)根据2套惯导各自东速误差中地球周期振荡项预测未来t+Δt时刻2套惯导经度误差地球周期振荡项预测值分别为:
需要强调的是,本发明所述的实施例是说明性的,而不是限定性的,因此本发明包括并不限于具体实施方式中所述的实施例,凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式,同样属于本发明保护的范围。
Claims (3)
1.一种惯导周期性误差自主估计与预测方法,其特征在于:包括以下步骤:
步骤1、以多普勒声纳北速为基准观测2套惯导北速误差,提取2套惯导北速误差中地球周期振荡项相位;观测2套惯导之间北速、东速差值,提取2套惯导北速、东速差值中地球周期振荡项幅值和相位;观测2套惯导之间纬度差值和经度差值,提取差值中地球周期振荡项幅值和相位;
步骤2、根据步骤1获得的相位信息将2套惯导北速、东速、纬度、经度差值中地球周期振荡项幅值分解,获得2套惯导各自北速、东速、纬度、经度误差中地球周期振荡项幅值;进一步获取2套惯导各自纬度、经度误差中地球周期振荡项相位,实现当前t时刻惯导纬度、经度误差中地球周期振荡项的估计;
步骤3、根据惯导北速、东速误差中地球周期振荡项信息实现未来一段时间惯导纬度、经度误差中地球周期振荡项的预测;
所述步骤2的具体实现方法为:
(1)通过构建一族三角形求解2套惯导各自北速误差中地球周期振荡幅值Av1、Av2,东速误差中地球周期振荡幅值A′v1、A′v2,纬度误差中地球周期振荡幅值A1、A2,经度误差中地球周期振荡项幅值A′1、A′2;构建一族三角形求解步骤:过点A作直线b,b绕A逆时针旋转度得到直线a,b绕A逆时针旋转/>得到直线c;在直线b上画出与A距离为Av21、A′v21、A21、A′21的点V、V1、P、P1,过V、V1、P、P1作c的平行线与a交于点W、W1、Q、Q1,量取线段WA、WV、W1A、W1V1、QA、QP、Q1A、Q1P1长度即为Av1、Av2、A′v1、A′v2、A1、A2、A′1、A′2;
2.根据权利要求1所述的一种惯导周期性误差自主估计与预测方法,其特征在于:所述步骤1的具体实现方法为:设2套惯导北速为v1、v2,东速v′1、v′2,多普勒声纳北速为vd,以多普勒声纳北速为基准观测2套惯导北速误差Ev1d=v1-vd、Ev2d=v2-vd;2套惯导北速差值为Ev21=v2-v1,东速差值为E′v21=v′2-v′1;读取Ev1d、Ev2d、Ev21、E′v21信号中距离当前时间最近的地球周期振荡峰值对应时间,分别记为t1d、t2d、t21、t′21,则Ev1d、Ev2d、Ev21、E′v21中地球周期振荡项相位为:读取Ev21、E′v21中地球周期振荡项幅值Av21、A′v21,T为地球周期;2套惯导纬度输出为lat1、lat2,提取2套惯导纬度差值Elat21=lat2-lat1中地球周期振荡项幅值记为A21,相位记为/>2套惯导经度输出为lon1、lon2,提取2套惯导经度差值Elon21=lon2-lon1中地球周期振荡项幅值A′21,相位/>
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111404564.8A CN114279462B (zh) | 2021-11-24 | 2021-11-24 | 一种惯导周期性误差自主估计与预测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111404564.8A CN114279462B (zh) | 2021-11-24 | 2021-11-24 | 一种惯导周期性误差自主估计与预测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114279462A CN114279462A (zh) | 2022-04-05 |
CN114279462B true CN114279462B (zh) | 2023-06-20 |
Family
ID=80869992
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111404564.8A Active CN114279462B (zh) | 2021-11-24 | 2021-11-24 | 一种惯导周期性误差自主估计与预测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114279462B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118274830B (zh) * | 2024-06-04 | 2024-08-20 | 中国船舶集团有限公司第七〇七研究所 | 一种基于多普勒探测信息的惯导误差修正方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102997916A (zh) * | 2011-09-15 | 2013-03-27 | 北京自动化控制设备研究所 | 一种自主提高定位定向***惯性姿态解算精度的方法 |
CN107402005A (zh) * | 2016-05-20 | 2017-11-28 | 北京自动化控制设备研究所 | 一种基于惯性/里程计/rfid的高精度组合导航方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103090865B (zh) * | 2013-01-06 | 2015-08-12 | 哈尔滨工程大学 | 一种调制型捷联惯性导航***姿态误差抑制方法 |
CN108303087B (zh) * | 2018-05-09 | 2020-03-20 | 中国人民解放军国防科技大学 | 一种高精度惯性导航***的舒拉周期振荡误差抑制方法 |
CN110044376B (zh) * | 2019-03-25 | 2020-11-24 | 中国人民解放军海军潜艇学院 | 一种惯性导航设备的校正方法及装置 |
CN110926497B (zh) * | 2019-04-08 | 2020-10-16 | 青岛中海潮科技有限公司 | 水下运载器惯导误差预测、浮起校正自动规划方法、装置 |
CN110926464B (zh) * | 2019-12-11 | 2020-10-16 | 中国人民解放军海军潜艇学院 | 一种基于双模式的惯性导航方法及*** |
-
2021
- 2021-11-24 CN CN202111404564.8A patent/CN114279462B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102997916A (zh) * | 2011-09-15 | 2013-03-27 | 北京自动化控制设备研究所 | 一种自主提高定位定向***惯性姿态解算精度的方法 |
CN107402005A (zh) * | 2016-05-20 | 2017-11-28 | 北京自动化控制设备研究所 | 一种基于惯性/里程计/rfid的高精度组合导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114279462A (zh) | 2022-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109443379B (zh) | 一种深海潜航器的sins/dvl水下抗晃动对准方法 | |
CN109737956B (zh) | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 | |
Eustice et al. | Synchronous‐clock, one‐way‐travel‐time acoustic navigation for underwater vehicles | |
CN102323586B (zh) | 一种基于海流剖面的uuv辅助导航方法 | |
CN102213594A (zh) | 一种无人潜航器海流观测数据融合方法 | |
CN110345941B (zh) | 深潜载人潜水器sins自辅助导航方法 | |
CN110274591B (zh) | 深潜载人潜水器adcp辅助sins导航方法 | |
CN111174774B (zh) | 一种某深度水层面模式下的导航信息融合方法及*** | |
CN111076728A (zh) | 基于dr/usbl的深潜载人潜水器组合导航方法 | |
CN114279462B (zh) | 一种惯导周期性误差自主估计与预测方法 | |
CN109814069A (zh) | 一种基于单定位信标的水下移动节点无源定位方法及其*** | |
CN109579850A (zh) | 基于对水速度辅助惯导的深水智能导航方法 | |
CN111722295A (zh) | 一种水下捷联式重力测量数据处理方法 | |
Zhang et al. | Underwater navigation based on real-time simultaneous sound speed profile correction | |
Cohen et al. | LiBeamsNet: AUV velocity vector estimation in situations of limited DVL beam measurements | |
CN114323065B (zh) | 基于多手段融合的水下自主导航***误差监测与估计方法 | |
Stanway | Dead reckoning through the water column with an acoustic Doppler current profiler: Field experiences | |
CN114459476A (zh) | 基于虚拟速度量测的水下无人潜航器测流dvl/sins组合导航方法 | |
CN114137625B (zh) | 一种基于两套惯导互观测的海洋垂线偏差测量方法 | |
CN113670303B (zh) | 一种基于rbf神经网络的sins/dvl组合导航流速补偿方法 | |
CN111964684B (zh) | 一种基于sins/lbl紧组合的水下导航混合定位方法及*** | |
CN112083466B (zh) | 一种顾及时间偏差的海底应答器定位方法及*** | |
Gallimore et al. | Synthetic baseline navigation using phase-coherent acoustic communication signals | |
CN103940416B (zh) | 一种电磁计程仪辅助的auv多程序并行解算导航方法 | |
Zhu et al. | Technology of SINS/USBL highly tightly coupled integrated navigation based on phase difference measurements |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |