CN112539745B - 基于外传感器辅助的双坐标系转换导航算法 - Google Patents
基于外传感器辅助的双坐标系转换导航算法 Download PDFInfo
- Publication number
- CN112539745B CN112539745B CN202010810327.0A CN202010810327A CN112539745B CN 112539745 B CN112539745 B CN 112539745B CN 202010810327 A CN202010810327 A CN 202010810327A CN 112539745 B CN112539745 B CN 112539745B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- inverse
- carrier
- latitude
- error
- 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
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
-
- 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/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
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
技术领域
本发明涉及捷联惯导技术领域,特别是涉及一种基于外传感器辅助的双坐标系转换导航算法。
背景技术
2017年5月8日,进一步提高我国海洋科技的创新水平并完善海洋科技的创新体系,国土资源部、国家海洋局和科技部三部门联合开展了一系列海洋领域科技创新专项规划,并指出为了应对极区环境的变化,必须深入对极区进行全方位的开展研究,开展极地相关设备的开发和关键技术的公关,可以为极地研究提供有力的支撑。随着全球气候的不断转暖,北极冰层的覆盖面积逐渐减少,2007年,美国宇航局卫星显示西北航道和东北航道有史以来第一次同时完全畅通,随后的几年高纬度地区附近的欧美等国纷纷尝试了北极航道,北极航道大大地缩短美洲、亚洲和欧洲之间的距离,节约了40%左右的航程,由此可见北极航道拥有巨大的商业意义与战略潜力。
导航系统的设计通常要求其在极区环境下仍然具备自主性、可靠性和高精度等优点。北冰洋地区水域,多数山脉会被白雪覆盖,特征提取相对困难,路标定位并不是很好的选择;极区环境恶劣气温较低,奥米加信号受高纬度地区极冠吸收现象影响,建设基站相对困难,信号难以接收,无线电定位也并不是很好的选择。在极区附近,由于高纬度地区电离层闪烁频繁,太阳黑子和磁暴会带来高强电磁干扰,星体辨识度很差,因此以卫星导航系统(Global Positioning System,GPS)、星敏感器为代表的天文导航手段极区精度会受到一定的影响。地磁磁极与运载体距离较近,罗经天向轴与地磁轴接近重合,作用于水平的分量相对较少,极区的极光和磁暴频发,严重时可使罗经的误差达到几十度,罗经在高纬度地区变得极易受干扰,寻北时间会极大地延长,罗经寻北也并不是很好的选择。
惯导系统(Inertial Navigation System,INS)是一种不依赖于任何的外部信息,也不向外辐射任何能量的自主导航系统。从原理上来讲不受地域上的限制,这也使得惯性导航系统成为火箭、飞机和船舶等航行器的必备导航工具,由于极区地球位置的特殊性,经线在近极点地区快速汇集成一点导致方位收敛速度过快方位跟踪电机施矩动态误差增大,无法很好地跟踪真实北向,在捷联惯性导航系统(Strapdown Inertial NavigationSystem,SINS)中,导航计算机中的数学平台在计算指北坐标系相对地球坐标系的角速度时,如果运载体跨越极点,也会产生计算溢出现象,从根本上来讲,目前基于指北方位编排的平台式惯导系统和捷联式惯导系统,在极区无法适用的原因本质上是寻北的困难。从惯性测量原理上来看,惯性器件测量不受地域限制,人为设置的指北基准和指北坐标系使得惯性导航系统不能适用。
针对以上问题,本发明设计了一种基于外传感器辅助的双坐标系转换导航算法,该方法首先针对极区惯导工作方式进行研究,采用逆坐标系方法,为航行器在高纬度地区提供角速度和加速度信息,而在低纬度区域下依然采用传统指北坐标系工作模式,借助外界传感器辅助减小转换后工作模式的初始误差。本发明专利可用于舰船极区导航,避免了捷联惯性导航系统在极区附近不能工作的问题。
发明内容
本发明的目的在于提供一种基于外传感器辅助的双坐标系转换导航算法。
实现本发明目的的技术方案为:一种基于外传感器辅助的双坐标系转换导航算法,包括以下步骤:
步骤一:建立逆地球坐标系,给出逆坐标系捷联惯导系统的工作机理,为航行器在高纬度地区提供角速度和加速度信息,以实现极区惯性导航。在低纬度区域下依然采用传统指北坐标系工作模式;
步骤二:建立基于圆球地球的误差模型,根据逆坐标系和指北坐标系的误差特性,建立误差预测向量;
步骤三:在不同位置下,通过各工作模式的常值误差项和累积误差项综合比较预测误差的大小和发散速度,判断用何种工作模式较为适当。借助外界传感器辅助以减小转换后工作模式的初始误差,以提高转换精度。
在步骤一中,逆地球坐标系模型如下:
旋转后得到的逆地球坐标系(etr系)的指向地理新北向(原地球坐标系的x轴),沿垂直方向指向天向(原地球坐标系的ye轴重合),与其他二轴构成右手坐标系(原地球坐标系的ze轴)。逆地球坐标系(etr-系)与原地球坐标系(e-系)之间的转换矩阵:
逆地球方程为
逆地球坐标系下卯酉圈椭圆参数方程为
任意纬度下卯酉圈半径离心率为
沿载体所在位置P切割得到的卯酉圈半径为RN
子午圈椭圆半径为RM
在逆坐标系工作模式下采用“逆东-北-天”地理坐标系(t系),以t系作为参考系的姿态微分方程为:
地球的转动引起的逆地理坐标系的角速度为:
由载体运动引起的逆地理坐标系相对逆地球坐标系角速度与常规坐标系中的表达一致。
子午圈与卯酉圈的主曲率半径随地球位置变化发生更新:
RN、RM分别为卯酉圈与子午圈的曲率半径。
在步骤二中,逆坐标系误差特性模型如下:
速度误差方程为
忽略误差的二阶小量后得到标量形式:
姿态误差方程为
两式微分后回代得到标量形式为
位置更新方程为
标量形式如下:
在步骤三中,切换算法具体如下:
tr系转换为n系:
在步骤三中,切换阈值确定方法为:
在切换过程中,分别设置穿入和穿出两个判定值,其中Ltran为工作模式切换预设边界线,Ltr-n为穿出极区边界线,Ln-tr为穿入极区边界线。
Ltr-n=Ltran-ΔLex
Ln-tr=Ltran+ΔLex
两个判定值的差值要远远大于短时间内惯导系统的定位误差,以避免导航工作模式的频繁切换。
根据不同惯导系统误差发散速度对预设边界线进行确定:
表1两种工作模式下陀螺引起误差比较(提取主导误差项)
表1-2是不同工作状态下航向与位置主导影响因素,综合以上影响因素并进行耦合,通过比较后选择预测系统误差较小的解算框架作为最后的工作模式,如表3所示。S
表2两种工作模式下加速度计引起误差比较(提取主导误差项)
表3工作模式判断
与现有技术相比,本发明的有益效果是:
本发明在传统的指北方位惯导系统无法工作的高纬度地区,通过逆坐标系极区算法实现导航,并且通过使用指北坐标系与逆坐标系交替工作,结合两者算法误差特性给出极地导航模式与低纬度地区导航模式的切换逻辑,充分利用两种算法在不同位置下的优势实现全纬度惯性导航。
附图说明
图1为逆地球坐标系示意图;
图2为逆坐标系算法流程图;
图3为工作模式切换流程图;
图4为切换前后误差仿真结果对比。
具体实施方式
下面结合附图对本发明进一步说明。
图2为逆坐标系统机械编排方块图
为了验证本发明的有效性,利用Matlab对设计的基于基于外传感器辅助的双坐标系转换导航算法进行仿真。
仿真参数设置如下:
初始位置:49.57°N,45°E
航向角:0
水平姿态:0
水平姿态摇摆幅度:5°
摇摆周期:10s
陀螺漂移:0.01°/h
DVL测速误差:0.1cm/s
模拟舰船行驶速度为12节向北行驶36h仿真结果:
以上述仿真条件,仿真的到的结果如图4所示。从DVL辅助转换结果可以看出,由于DVL无法像GPS可以提供位置基准,因此无法保证转换后的位置初始误差,但是切换后的位置误差和航向误差短时间内发散速度变慢。
因此,仿真结果表明,本发明提出的基于外传感器辅助的双坐标系转换导航算法受外界辅助传感器的影响,载体在切换工作模式之后导航参数误差被拉回,解决了工作模式转换和切换判断的问题。
Claims (1)
1.一种基于外传感器辅助的双坐标系转换导航算法,其特征在于,包括以下步骤:
步骤一:建立逆地球坐标系,给出逆坐标系捷联惯导系统的工作机理,为航行器在高纬度地区提供角速度和加速度信息,以实现极区惯性导航,在低纬度区域下依然采用传统指北坐标系工作模式,其中,所述逆地球坐标系的模型如下:
旋转后得到的逆地球坐标系 指向地理新北向,即原地球坐标系的x轴,沿垂直方向指向天向,即原地球坐标系的ye轴重合,与其他二轴构成右手坐标系,即原地球坐标系的ze轴,逆地球坐标系与原地球坐标系之间的转换矩阵:
逆地球方程为:
其中,所述逆坐标系捷联惯导系统的工作机理如下:
逆地球坐标系下卯酉圈椭圆参数方程为
任意纬度下卯酉圈半径离心率为
沿载体所在位置P切割得到的卯酉圈半径为RN
子午圈椭圆半径为RM
在逆坐标系工作模式下采用“逆东-北-天”地理坐标系,以所述“逆东-北-天”地理坐标系作为参考系的姿态微分方程为:
地球的转动引起的逆地理坐标系的角速度为:
由载体运动引起的逆地理坐标系相对逆地球坐标系角速度与常规坐标系中的表达一致;
子午圈与卯酉圈的主曲率半径随地球位置变化发生更新:
其中,RN、RM分别为卯酉圈与子午圈的曲率半径;步骤二:建立基于圆球地球的误差模型,根据逆坐标系和指北坐标系的误差特性,建立误差预测向量,具体为:
速度误差方程为
姿态误差方程为
位置更新方程为
标量形式如下:
步骤三:在不同位置下,通过各工作模式的常值误差项和累积误差项综合比较预测误差的大小和发散速度,判断用何种工作模式较为适当,借助外界传感器辅助的思路减小转换后工作模式的初始误差,利用外传感器辅助转换思路可以提高转换精度,具体地,
切换阈值判定模型为:
在切换过程中,分别设置穿入和穿出两个判定值,其中Ltran为工作模式切换预设边界线,Ltr-n为穿出极区边界线,Ln-tr为穿入极区边界线:
Ltr-n=Ltran-ΔLex
Ln-tr=Ltran+ΔLex
两个判定值的差值要远远大于短时间内惯导系统的定位误差,以避免导航工作模式的频繁切换。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010810327.0A CN112539745B (zh) | 2020-08-13 | 2020-08-13 | 基于外传感器辅助的双坐标系转换导航算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010810327.0A CN112539745B (zh) | 2020-08-13 | 2020-08-13 | 基于外传感器辅助的双坐标系转换导航算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112539745A CN112539745A (zh) | 2021-03-23 |
CN112539745B true CN112539745B (zh) | 2021-09-21 |
Family
ID=75013444
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010810327.0A Active CN112539745B (zh) | 2020-08-13 | 2020-08-13 | 基于外传感器辅助的双坐标系转换导航算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112539745B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113155125B (zh) * | 2021-05-09 | 2022-06-14 | 中国人民解放军国防科技大学 | 一种大飞机ins/gnss全球组合导航方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103471614A (zh) * | 2013-08-26 | 2013-12-25 | 哈尔滨工程大学 | 一种基于逆坐标系的极区传递对准方法 |
CN108627154A (zh) * | 2017-03-16 | 2018-10-09 | 霍尼韦尔国际公司 | 极地区域操作姿态与航向参考系统 |
WO2019089966A1 (en) * | 2017-11-02 | 2019-05-09 | The Government Of The United States Of America, As Represented By The Secretary Of The Navy | Improved atmospheric thermal location estimation |
CN110347173A (zh) * | 2019-08-21 | 2019-10-18 | 哈尔滨工业大学 | 一种基于非连续自适应控制的航天器姿态跟踪控制方法 |
CN110457813A (zh) * | 2019-08-08 | 2019-11-15 | 西北工业大学 | 基于横向地理坐标系的虚拟极区方法 |
CN111060140A (zh) * | 2019-12-31 | 2020-04-24 | 西北工业大学 | 一种地球椭球模型下的极区惯性导航误差获得方法 |
-
2020
- 2020-08-13 CN CN202010810327.0A patent/CN112539745B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103471614A (zh) * | 2013-08-26 | 2013-12-25 | 哈尔滨工程大学 | 一种基于逆坐标系的极区传递对准方法 |
CN108627154A (zh) * | 2017-03-16 | 2018-10-09 | 霍尼韦尔国际公司 | 极地区域操作姿态与航向参考系统 |
WO2019089966A1 (en) * | 2017-11-02 | 2019-05-09 | The Government Of The United States Of America, As Represented By The Secretary Of The Navy | Improved atmospheric thermal location estimation |
CN110457813A (zh) * | 2019-08-08 | 2019-11-15 | 西北工业大学 | 基于横向地理坐标系的虚拟极区方法 |
CN110347173A (zh) * | 2019-08-21 | 2019-10-18 | 哈尔滨工业大学 | 一种基于非连续自适应控制的航天器姿态跟踪控制方法 |
CN111060140A (zh) * | 2019-12-31 | 2020-04-24 | 西北工业大学 | 一种地球椭球模型下的极区惯性导航误差获得方法 |
Non-Patent Citations (3)
Title |
---|
Hybrid Transverse Polar Navigation for High-Precision and Long-Term INSs;Ruonan Wu 等;《sensors》;20180512;第1-18页 * |
基于逆坐标系的极区传递对准技术研究;孙枫 等;《弹箭与制导学报》;20140831;第34卷(第4期);第179-186页 * |
极区航海用惯性导航系统综述;赵玉新 等;《导航定位与授时》;20200331;第7卷(第2期);第1-10页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112539745A (zh) | 2021-03-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104635251B (zh) | 一种ins/gps组合定位定姿新方法 | |
CN106443746B (zh) | 一种低成本双天线gnss/ahrs组合测姿方法 | |
CN110487301A (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
CN103235328B (zh) | 一种gnss与mems组合导航的方法 | |
US8489321B2 (en) | Nature event signaling | |
CN110457813B (zh) | 基于横向地理坐标系的虚拟极区方法 | |
CN105589064A (zh) | Wlan位置指纹数据库快速建立和动态更新系统及方法 | |
CN104713555A (zh) | 应用全天域中性点辅助定向的车辆自主导航方法 | |
CN103471616A (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN113311436A (zh) | 一种移动平台上激光测风雷达运动姿态测风订正方法 | |
CN103389092A (zh) | 一种系留飞艇姿态测量装置及测量方法 | |
CN105116430B (zh) | 用于动中通的伪航向的基于卡尔曼滤波的海泊态搜星方法 | |
CN104215242A (zh) | 一种基于横向游移坐标系的极区惯性导航方法 | |
CN109813306A (zh) | 一种无人车规划轨迹卫星定位数据可信度计算方法 | |
CN103697885A (zh) | 自动补偿磁偏角的远程定位方法 | |
CN105841698A (zh) | 一种无需调零的auv舵角精确实时测量系统 | |
CN106093992A (zh) | 一种基于cors的亚米级组合定位导航系统及导航方法 | |
CN112539745B (zh) | 基于外传感器辅助的双坐标系转换导航算法 | |
Xiao et al. | Residual attention network-based confidence estimation algorithm for non-holonomic constraint in GNSS/INS integrated navigation system | |
CN111207773B (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN103940429A (zh) | 一种惯性导航系统横坐标系下载体姿态的实时测量方法 | |
JPH11271069A (ja) | 航法装置 | |
JP4631959B2 (ja) | 移動体ナビゲーション装置及び地図画像表示方法 | |
CN105115507A (zh) | 一种基于双imu的双模式室内个人导航系统及方法 | |
CN101943584B (zh) | 基于ccd星敏感器的对准方法 |
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 |