CN110457813B - 基于横向地理坐标系的虚拟极区方法 - Google Patents
基于横向地理坐标系的虚拟极区方法 Download PDFInfo
- Publication number
- CN110457813B CN110457813B CN201910730938.1A CN201910730938A CN110457813B CN 110457813 B CN110457813 B CN 110457813B CN 201910730938 A CN201910730938 A CN 201910730938A CN 110457813 B CN110457813 B CN 110457813B
- Authority
- CN
- China
- Prior art keywords
- transverse
- polar region
- coordinate system
- geographic coordinate
- virtual
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 239000011159 matrix material Substances 0.000 claims abstract description 30
- 230000005484 gravity Effects 0.000 claims abstract description 17
- 230000001133 acceleration Effects 0.000 claims abstract description 13
- 238000012937 correction Methods 0.000 claims abstract description 10
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 230000001419 dependent effect Effects 0.000 claims description 3
- 238000002474 experimental method Methods 0.000 claims description 2
- 238000012360 testing method Methods 0.000 abstract description 12
- 230000010354 integration Effects 0.000 abstract description 3
- 230000000694 effects Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000012795 verification Methods 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012067 mathematical method Methods 0.000 description 1
- 238000013508 migration Methods 0.000 description 1
- 230000005012 migration Effects 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Computing Systems (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于横向地理坐标系的虚拟极区方法,用于解决现有虚拟极区方法适用性差的技术问题。技术方案是保持横向地理系下的姿态矩阵、速度和高度信息不变,通过对补偿椭球校正系数后的横向速度积分重构极区位置轨迹;将非极区试验获得的陀螺和加速度计数据在横向地理坐标系下扣除当地地球自转角速率和重力加速度,并叠加虚拟极区的地球自转角速率和重力矢量,完成惯性传感器数据的极区重构。本发明在横向地理坐标系下重构极区轨迹数据和惯性传感器数据,使载体相对于当地水平面的运动特征保持不变,扩大了适用区域,能够适用于地球表面除横向极点外的任意位置;通过椭球校正系数避免了圆球近似,提高了建模精度。
Description
技术领域
本发明涉及一种虚拟极区方法,特别涉及一种基于横向地理坐标系的虚拟极区方法。
背景技术
由于地球两极独特的地理位置,导航算法研究人员很难有机会到极区进行实际试验验证,而纯数学仿真方法又难以真实反映载体的运动特征和惯性传感器误差。因此,研究基于真实试验数据的虚拟极区技术具有重要意义,能够将中低纬度地区的试验数据通过数学方法转换至极区进行等效的导航试验验证。
文献“基于虚拟极点验证极区导航算法的方法研究,IEEE中国制导、导航与控制学术会议,2016,p2809-2814”公开了一种以赤道上任意一点为新极点的虚拟极区方法。该方法通过地理坐标系与横向地理坐标系之间的相互关系,将地球自转轴转换至赤道以建立虚拟极区,并采用横向游移导航编排进行了合理性验证。但是,文献所述方法仅能够将赤道附近区域虚拟为极区,要适应地球表面其它区域还需要进行繁琐的算法推导。此外,文献所述方法将地球近似为圆球模型,采用高斯曲率半径作为圆球半径,存在原理性误差,不满足高精度导航验证的需求。
发明内容
为了克服现有虚拟极区方法适用性差的不足,本发明提供一种基于横向地理坐标系的虚拟极区方法。该方法保持横向地理系下的姿态矩阵、速度和高度信息不变,通过对补偿椭球校正系数后的横向速度积分重构极区位置轨迹;将非极区试验获得的陀螺和加速度计数据在横向地理坐标系下扣除当地地球自转角速率和重力加速度,并叠加虚拟极区的地球自转角速率和重力矢量,完成惯性传感器数据的极区重构。本发明在横向地理坐标系下重构极区轨迹数据和惯性传感器数据,使载体相对于当地水平面的运动特征保持不变,扩大了方法的适用区域,能够适用于地球表面除横向极点外的任意位置;通过椭球校正系数避免了圆球近似,提高了建模精度,从而达到与真实极区试验相同的效果。
本发明解决其技术问题所采用的技术方案:一种基于横向地理坐标系的虚拟极区方法,其特点是包括以下步骤:
符号“*”表示重构的极区轨迹相关参数。考虑地球曲率的影响,位置方向余弦矩阵通过求解微分方程获得
步骤二、惯性传感器数据重构。在横向地理坐标系内扣除当地地球自转角速率和重力加速度,并叠加虚拟极区的地球自转角速率和重力矢量,完成陀螺和加速度计数据的重构:
式中,和为实际试验中得到的陀螺和加速度计输出,和为极区重构的陀螺和加速度计数据;姿态矩阵 为虚拟极区横向地理坐标系下的地球自转角速率;为虚拟极区横向地理坐标系下的重力加速度; 和为当地横向地理坐标系下的地球自转和牵连运动角速率;为当地横向地理坐标系下的重力加速度。
本发明的有益效果是:该方法保持横向地理系下的姿态矩阵、速度和高度信息不变,通过对补偿椭球校正系数后的横向速度积分重构极区位置轨迹;将非极区试验获得的陀螺和加速度计数据在横向地理坐标系下扣除当地地球自转角速率和重力加速度,并叠加虚拟极区的地球自转角速率和重力矢量,完成惯性传感器数据的极区重构。本发明在横向地理坐标系下重构极区轨迹数据和惯性传感器数据,使载体相对于当地水平面的运动特征保持不变,扩大了方法的适用区域,能够适用于地球表面除横向极点外的任意位置;通过椭球校正系数避免了圆球近似,提高了建模精度,从而达到与真实极区试验相同的效果。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明方法实施例中横向地球坐标系和横向地理坐标系示意图。
图2是本发明方法实施例中虚拟极区轨迹曲线。
图3是本发明方法实施例中虚拟极区轨迹的纯惯性导航结果。
具体实施方式
参照图1-3。本发明基于横向地理坐标系的虚拟极区方法具体步骤如下:
1、极区轨迹数据重构。
定义b为载体坐标系,坐标轴指向载体的右前上方向;i和e系为传统的惯性坐标系和地球坐标系;g为地理坐标系,坐标轴指向当地位置的东北天方向,该坐标系下的位置坐标用pg=[λ L h]T表示。定义et为横向地球坐标系,由e系绕oxe轴转动-90°,再绕oze转动-90°后获得;gt为横向地理坐标系,坐标轴分别指向当前位置横向伪经纬网的东北天方向,该坐标系下的位置坐标用表示。
式中α为横向方位角,并且
其中[λ,L]为当地经纬度,[λt,Lt]为当地横向经纬度。
式中符号“*”表示重构的极区轨迹相关参数。考虑地球曲率的影响,位置方向余弦矩阵通过求解微分方程获得
2、惯性传感器数据重构。
在横向地理坐标系内扣除当地地球自转角速率和重力加速度,并叠加虚拟极区的地球自转角速率和重力矢量,完成陀螺和加速度计数据的重构:
其中ωie为地球自转角速率模值,g*为根据极区纬度L*计算的重力加速度模值。
其中RM、RN为当地的子午圈和卯酉圈半径。
下面通过仿真数据对本发明的具体实施方式和实施效果做进一步说明。
仿真条件:非极区试验数据的起始点为[120°E,50°N,0],舰船沿120°E经线以10m/s的速度向北行驶48小时,航行期间无姿态和高度变化。利用该试验数据进行极区轨迹重构,并将极区航线的起点置于北极点附近。
图2显示了原始轨迹曲线和重构的极区轨迹曲线。从轨迹外形上看,本发明技术能够在极区准确复现非极区的试验轨迹。
图3显示了在不叠加误差情况下,利用重构的极区轨迹进行纯惯性导航解算的水平位置误差。图3中导航48h的最大位置误差在0.05m以内,主要由字长舍入误差引起,表明该虚拟极区技术不存在原理性误差。实施效果表明,本发明技术符合地球椭球模型和标准力学编排,建模精度高。
Claims (1)
1.一种基于横向地理坐标系的虚拟极区方法,其特征在于包括以下步骤:
符号“*”表示重构的极区轨迹相关参数;考虑地球曲率的影响,位置方向余弦矩阵通过求解微分方程获得
步骤二、惯性传感器数据重构;在横向地理坐标系内扣除当地地球自转角速率和重力加速度,并叠加虚拟极区的地球自转角速率和重力矢量,完成陀螺和加速度计数据的重构:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910730938.1A CN110457813B (zh) | 2019-08-08 | 2019-08-08 | 基于横向地理坐标系的虚拟极区方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910730938.1A CN110457813B (zh) | 2019-08-08 | 2019-08-08 | 基于横向地理坐标系的虚拟极区方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110457813A CN110457813A (zh) | 2019-11-15 |
CN110457813B true CN110457813B (zh) | 2022-07-05 |
Family
ID=68485528
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910730938.1A Active CN110457813B (zh) | 2019-08-08 | 2019-08-08 | 基于横向地理坐标系的虚拟极区方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110457813B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110906927B (zh) * | 2019-12-06 | 2023-04-14 | 中国空空导弹研究院 | 一种凝固坐标系下重力加速度简化算法 |
CN110986931B (zh) * | 2019-12-10 | 2021-06-25 | 清华大学 | 全球混合导航方法、装置、计算机设备和可读存储介质 |
CN110986932B (zh) * | 2019-12-10 | 2022-01-14 | 清华大学 | 惯性导航数据的重构方法、装置、计算机设备和存储介质 |
CN111060140B (zh) * | 2019-12-31 | 2022-08-02 | 西北工业大学 | 一种地球椭球模型下的极区惯性导航误差获得方法 |
CN112539745B (zh) * | 2020-08-13 | 2021-09-21 | 哈尔滨工业大学 | 基于外传感器辅助的双坐标系转换导航算法 |
CN111928848B (zh) * | 2020-09-24 | 2020-12-18 | 中国人民解放军国防科技大学 | 一种基于虚拟圆球法向量模型的极区惯性导航方法 |
CN113124879A (zh) * | 2021-04-23 | 2021-07-16 | 苏州大学 | 虚拟圆球模型下sins/dvl极区组合导航方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103528584A (zh) * | 2013-11-04 | 2014-01-22 | 东南大学 | 基于横向地理坐标系的极区惯性导航方法 |
CN104215242A (zh) * | 2014-09-30 | 2014-12-17 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
CN104713559A (zh) * | 2015-02-01 | 2015-06-17 | 西北工业大学 | 一种高精度sins模拟器的设计方法 |
CN105783943A (zh) * | 2016-04-26 | 2016-07-20 | 哈尔滨工程大学 | 一种基于无迹卡尔曼滤波的极区环境下舰船大方位失准角传递对准方法 |
CN106595652A (zh) * | 2016-11-30 | 2017-04-26 | 西北工业大学 | 车辆运动学约束辅助的回溯式行进间对准方法 |
CN108225325A (zh) * | 2017-12-29 | 2018-06-29 | 中国人民解放军海军工程大学 | 基于虚拟球模型的极地横向导航方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7744122B2 (en) * | 1995-12-12 | 2010-06-29 | Automotive Technologies International, Inc. | Driver side aspirated airbags |
US8650220B2 (en) * | 2012-06-05 | 2014-02-11 | Google Inc. | System and method for storing and retrieving geospatial data |
CN107806874B (zh) * | 2017-10-23 | 2019-01-15 | 西北工业大学 | 一种视觉辅助的捷联惯导极区初始对准方法 |
-
2019
- 2019-08-08 CN CN201910730938.1A patent/CN110457813B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103528584A (zh) * | 2013-11-04 | 2014-01-22 | 东南大学 | 基于横向地理坐标系的极区惯性导航方法 |
CN104215242A (zh) * | 2014-09-30 | 2014-12-17 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
CN104713559A (zh) * | 2015-02-01 | 2015-06-17 | 西北工业大学 | 一种高精度sins模拟器的设计方法 |
CN105783943A (zh) * | 2016-04-26 | 2016-07-20 | 哈尔滨工程大学 | 一种基于无迹卡尔曼滤波的极区环境下舰船大方位失准角传递对准方法 |
CN106595652A (zh) * | 2016-11-30 | 2017-04-26 | 西北工业大学 | 车辆运动学约束辅助的回溯式行进间对准方法 |
CN108225325A (zh) * | 2017-12-29 | 2018-06-29 | 中国人民解放军海军工程大学 | 基于虚拟球模型的极地横向导航方法 |
Non-Patent Citations (3)
Title |
---|
The Error Analysis on the Inertial Navigation in Polar Region Based on Grid Coordinate System;Sun Yongkan 等;《Projectiles, Rockets, Missiles and Guidance》;20170831;第37卷(第4期);第148-152页 * |
Transversal Strapdown INS Based on Reference Ellipsoid for Vehicle in the Polar Region;Qian Li 等;《The Journal of Navigation》;20160331;第69卷(第2期);第335-352页 * |
基于横向地球坐标的惯性导航系统研究;周爱军 等;《江苏科技大学学报(自然科学版)》;20170630;第31卷(第3期);第350-355页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110457813A (zh) | 2019-11-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110457813B (zh) | 基于横向地理坐标系的虚拟极区方法 | |
CN108225325B (zh) | 基于虚拟球模型的极地横向导航方法 | |
CN110196066B (zh) | 基于格网姿态速度信息不变的虚拟极区方法 | |
CN102829781B (zh) | 一种旋转式捷联光纤罗经实现的方法 | |
CN103528584B (zh) | 基于横向地理坐标系的极区惯性导航方法 | |
CN108426575B (zh) | 用地球椭球模型改进的捷联惯导极地横向导航方法 | |
CN103047999B (zh) | 一种舰载主/子惯导传递对准过程中的陀螺误差快速估计方法 | |
CN101706281A (zh) | 惯性/天文/卫星高精度组合导航系统及其导航方法 | |
CN109211269A (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN111928848B (zh) | 一种基于虚拟圆球法向量模型的极区惯性导航方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN108871326A (zh) | 一种单轴旋转调制惯性-天文深组合导航方法 | |
CN115200574A (zh) | 一种地球椭球模型下的极区横向组合导航方法 | |
CN112729332B (zh) | 一种基于旋转调制的对准方法 | |
CN110806220A (zh) | 一种惯导系统初始对准方法及装置 | |
Fu et al. | Unified all-Earth navigation mechanization and virtual polar region technology | |
CN110514200B (zh) | 一种惯性导航系统及高转速旋转体姿态测量方法 | |
CN116734887A (zh) | 基于速度误差修正模型的极地双惯导协同标定方法 | |
CN111207773B (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
Qin et al. | Improved transversal polar navigation mechanism for strapdown INS using ellipsoidal Earth model | |
CN110388942B (zh) | 一种基于角度和速度增量的车载姿态精对准系统 | |
CN106441297B (zh) | 惯导系统的重力误差矢量获取方法和装置 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 | |
CN111060140B (zh) | 一种地球椭球模型下的极区惯性导航误差获得方法 | |
CN105300407A (zh) | 一种用于单轴调制激光陀螺惯导系统的海上动态启动方法 |
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 |