CN110196066B - 基于格网姿态速度信息不变的虚拟极区方法 - Google Patents
基于格网姿态速度信息不变的虚拟极区方法 Download PDFInfo
- Publication number
- CN110196066B CN110196066B CN201910388718.5A CN201910388718A CN110196066B CN 110196066 B CN110196066 B CN 110196066B CN 201910388718 A CN201910388718 A CN 201910388718A CN 110196066 B CN110196066 B CN 110196066B
- Authority
- CN
- China
- Prior art keywords
- polar region
- coordinate system
- virtual
- conversion
- grid
- 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 33
- 238000006243 chemical reaction Methods 0.000 claims abstract description 35
- 238000012360 testing method Methods 0.000 claims abstract description 17
- 230000005484 gravity Effects 0.000 claims abstract description 12
- 239000013598 vector Substances 0.000 claims abstract description 12
- 239000011159 matrix material Substances 0.000 claims description 16
- 230000001133 acceleration Effects 0.000 claims description 10
- 150000001875 compounds Chemical class 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000001131 transforming effect Effects 0.000 claims description 3
- 238000002474 experimental method Methods 0.000 claims description 2
- 238000012795 verification Methods 0.000 abstract description 12
- 230000000694 effects Effects 0.000 abstract description 7
- 238000004088 simulation Methods 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000012067 mathematical method Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于格网姿态速度信息不变的虚拟极区方法,用于解决现有虚拟极区方法导航验证效果差的技术问题。技术方案是在格网坐标系下将非极区外场试验数据转换至极区进行导航验证,通过参考信息转换、初始状态转换和惯性传感器数据转换完成虚拟极区建模。本发明通过参考信息转换、初始状态转换和惯性传感器数据转换,使虚拟极点同时具备地球自转与重力矢量平行和经线快速收敛两大特征,提高了模型完整性;在格网坐标系下将非极区外场试验数据转换至极区进行导航验证,并考虑地球曲率影响,能够保证转换前后载体相对地面的姿态和速度信息不发生变化,提高了模型的真实性和建模精度,达到在极地进行真实试验的效果。
Description
技术领域
本发明涉及一种虚拟极区方法,特别涉及一种基于格网姿态速度信息不变的虚拟极区方法。
背景技术
试验验证对极区导航算法的评估具有重要意义。由于地理位置、交通工具、气候、经费和实验条件的限制,研究人员很难到达高纬度地区进行实际外场试验。而纯数学仿真方法又很难真实反应载体的动力学模型和外部环境的影响,不能得到全面的验证结论。另一种有效的途径是,将中低纬度地区的真实试验数据通过数学方法转换至极区,以完成极区导航算法的验证,这种方法即称为虚拟极区技术。
文献“虚拟极区技术在惯性***极区导航中的应用研究,光学陀螺及***技术发展与应用研讨会论文集,2016,p69-73”公开了一种基于横向经纬度的虚拟极区方法。该方法借助地球坐标系下的矩阵变换,可将地球表面的任意点设置为虚拟极点,并给出了虚拟地理经纬度、虚拟航向和虚拟格网航向计算方法。但是,文献所述方法仅针对极区经线收敛这一特点进行了建模,而忽略了重力加速度和地球自转共线这一重要因素,未考虑惯性传感器数据的重构,因此虚拟方法是不全面的。此外,按照文献所述的直接转换方法,由于地球曲率差异的影响,非极区的水平飞行将被转换成为极区内的爬升或下降运动,导致气压高度数据也无法使用,影响导航验证的效果。
发明内容
为了克服现有虚拟极区方法导航验证效果差的不足,本发明提供一种基于格网姿态速度信息不变的虚拟极区方法。该方法在格网坐标系下将非极区外场试验数据转换至极区进行导航验证,通过参考信息转换、初始状态转换和惯性传感器数据转换完成虚拟极区建模。本发明通过参考信息转换、初始状态转换和惯性传感器数据转换,使虚拟极点同时具备地球自转与重力矢量平行和经线快速收敛两大特征,提高了模型完整性;在格网坐标系下将非极区外场试验数据转换至极区进行导航验证,并考虑地球曲率影响,能够保证转换前后载体相对地面的姿态和速度信息不发生变化,提高了模型的真实性和建模精度,达到在极地进行真实试验的效果。
本发明解决其技术问题所采用的技术方案:一种基于格网姿态速度信息不变的虚拟极区方法,其特点是包括以下步骤:
步骤一、参考信息转换。
定义b为载体坐标系,坐标轴指向载体的右前上方向;g为地理坐标系,坐标轴指向当地位置的东北天方向;定义G为格网坐标系,坐标轴yG与格林威治子午线平行;i和e定义为传统的惯性坐标系和地球坐标系。
在非极区的外场试验中,将惯性/卫星组合导航的结果作为参考信息,包含地理坐标系下的姿态矩阵速度vg和位置pg。地理系位置包括经度、纬度和高度信息,即pg=[λL h]T。将地理系的姿态矩阵和速度转换至格网坐标系:
式中,σ为格网角,并且
步骤二、初始状态转换。
步骤三、惯性传感器数据转换。
通过扣除当地实际的地球自转角速率和重力加速度,并叠加虚拟极区的地球自转和重力矢量,完成陀螺和加速度计的数据重构:
式中,和为真实试验中得到的陀螺和加速度计输出,和为极区重构的陀螺和加速度计数据;和为当地实际地球自转和牵连运动角速率矢量,ωie为地球自转角速率,通过将当地位置带入式(5)计算;和为虚拟极区的地球自转和牵连运动角速率矢量,且gc为当地重力加速度模值; 为虚拟极区的重力加速度;当地牵连运动角速率根据位置pg和速度vG计算:
其中
本发明的有益效果是:该方法在格网坐标系下将非极区外场试验数据转换至极区进行导航验证,通过参考信息转换、初始状态转换和惯性传感器数据转换完成虚拟极区建模。本发明通过参考信息转换、初始状态转换和惯性传感器数据转换,使虚拟极点同时具备地球自转与重力矢量平行和经线快速收敛两大特征,提高了模型完整性;在格网坐标系下将非极区外场试验数据转换至极区进行导航验证,并考虑地球曲率影响,能够保证转换前后载体相对地面的姿态和速度信息不发生变化,提高了模型的真实性和建模精度,达到在极地进行真实试验的效果。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明方法实施例虚拟极区轨迹曲线示意图;
图2是本发明方法实施例虚拟极区轨迹的纯惯性导航位置结果示意图。
具体实施方式
参照图1-2。本发明基于格网姿态速度信息不变的虚拟极区方法具体步骤如下:
1、参考信息转换。
定义b为载体坐标系,坐标轴指向载体的右前上方向;g为地理坐标系,坐标轴指向当地位置的东北天方向;定义G为格网坐标系,坐标轴yG与格林威治子午线平行;i和e定义为传统的惯性坐标系和地球坐标系。
在非极区的外场试验中,将惯性/卫星组合导航的结果作为参考信息,包含地理坐标系下的姿态矩阵速度vg和位置pg。地理系位置包括经度、纬度和高度信息,即pg=[λL h]T。首先将地理系的姿态矩阵和速度转换至格网坐标系:
式中σ为格网角,并且
2、初始状态转换。
3、惯性传感器数据转换。
通过扣除当地实际的地球自转角速率和重力加速度,并叠加虚拟极区的地球自转和重力矢量,完成陀螺和加速度计的数据重构:
式中和为真实试验中得到的陀螺和加速度计输出,和为极区重构的陀螺和加速度计数据;和为当地实际地球自转和牵连运动角速率矢量,ωie为地球自转角速率,可将当地位置带入式(5)计算; 和为虚拟极区的地球自转和牵连运动角速率矢量,且gc为当地重力加速度模值; 为虚拟极区的重力加速度;当地牵连运动角速率可根据位置pg和速度vG计算
其中
下面通过仿真数据对本发明的具体实施方式和实施效果做进一步说明。
仿真条件:原非极区轨迹的起始点为[120°E,55°N,5000m],飞机沿120°E经线以300m/s的速度向北飞行,3h后到达纬度84°N,,飞行距离为1,740海里。飞行期间无姿态和高度变化。虚拟极区过程中,将重构的极区航线起点置于北极点。
图1显示了原始轨迹曲线和虚拟后的极区轨迹曲线。从轨迹形状上对比发现,本发明方法很好地在极区重现了非极区的真实轨迹。
图2显示了在不叠加误差情况下利用虚拟极区轨迹进行纯惯性导航解算的位置误差。可以看出,导航3h最大位置误差在0.2m以内,这与导航误差在0.8海里/小时量级的航空标准惯导***相比完全可忽略。该结果表明,本发明方法生成的虚拟轨迹与极区地球模型和标准力学编排完全一致,建模精度高。
Claims (1)
1.一种基于格网姿态速度信息不变的虚拟极区方法,其特征在于包括以下步骤:
步骤一、参考信息转换;
定义b为载体坐标系,坐标轴指向载体的右前上方向;g为地理坐标系,坐标轴指向当地位置的东北天方向;定义G为格网坐标系,坐标轴yG与格林威治子午线平行;i和e定义为传统的惯性坐标系和地球坐标系;
在非极区的外场试验中,将惯性/卫星组合导航的结果作为参考信息,包含地理坐标系下的姿态矩阵速度vg和位置pg;地理系位置包括经度、纬度和高度信息,即pg=[λ L h]T;将地理系的姿态矩阵和速度转换至格网坐标系:
式中,σ为格网角,并且
其中,虚拟极区的地理坐标系位置pg*由位置pe*转换获得;
步骤二、初始状态转换;
步骤三、惯性传感器数据转换;
通过扣除当地实际的地球自转角速率和重力加速度,并叠加虚拟极区的地球自转和重力矢量,完成陀螺和加速度计的数据重构:
式中,和为真实试验中得到的陀螺和加速度计输出,和为极区重构的陀螺和加速度计数据; 和为当地实际地球自转和牵连运动角速率矢量,ωie为地球自转角速率,通过将当地位置带入式(5)计算;和为虚拟极区的地球自转和牵连运动角速率矢量,且gG=[0 0 -gc]T,gc为当地重力加速度模值; 为虚拟极区的重力加速度;当地牵连运动角速率根据位置pg和速度vG计算:
其中
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910388718.5A CN110196066B (zh) | 2019-05-10 | 2019-05-10 | 基于格网姿态速度信息不变的虚拟极区方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910388718.5A CN110196066B (zh) | 2019-05-10 | 2019-05-10 | 基于格网姿态速度信息不变的虚拟极区方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110196066A CN110196066A (zh) | 2019-09-03 |
CN110196066B true CN110196066B (zh) | 2022-07-15 |
Family
ID=67752539
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910388718.5A Active CN110196066B (zh) | 2019-05-10 | 2019-05-10 | 基于格网姿态速度信息不变的虚拟极区方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110196066B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111060140B (zh) * | 2019-12-31 | 2022-08-02 | 西北工业大学 | 一种地球椭球模型下的极区惯性导航误差获得方法 |
CN111947685B (zh) * | 2020-07-30 | 2021-12-07 | 苏州大学 | 一种极区格网坐标系动基座粗对准方法 |
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 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
CN107543545A (zh) * | 2017-10-30 | 2018-01-05 | 中国人民解放军国防科技大学 | 极区双航海惯性导航***定位信息融合方法 |
CN107957271A (zh) * | 2017-11-22 | 2018-04-24 | 哈尔滨工程大学 | 一种用于水下无人航行器在极区导航的初始精对准方法 |
CN108225325A (zh) * | 2017-12-29 | 2018-06-29 | 中国人民解放军海军工程大学 | 基于虚拟球模型的极地横向导航方法 |
CN108426575A (zh) * | 2018-02-12 | 2018-08-21 | 中国人民解放军海军工程大学 | 用地球椭球模型改进的捷联惯导极地横向导航方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2273692B1 (en) * | 2009-07-06 | 2016-08-31 | Airbus Defence and Space SAS | Virtual polar satellite ground station for low orbit earth observation satellites based on a geostationary satellite pointing an antenna over an earth pole |
-
2019
- 2019-05-10 CN CN201910388718.5A patent/CN110196066B/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 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
CN107543545A (zh) * | 2017-10-30 | 2018-01-05 | 中国人民解放军国防科技大学 | 极区双航海惯性导航***定位信息融合方法 |
CN107957271A (zh) * | 2017-11-22 | 2018-04-24 | 哈尔滨工程大学 | 一种用于水下无人航行器在极区导航的初始精对准方法 |
CN108225325A (zh) * | 2017-12-29 | 2018-06-29 | 中国人民解放军海军工程大学 | 基于虚拟球模型的极地横向导航方法 |
CN108426575A (zh) * | 2018-02-12 | 2018-08-21 | 中国人民解放军海军工程大学 | 用地球椭球模型改进的捷联惯导极地横向导航方法 |
Non-Patent Citations (1)
Title |
---|
李琳等.虚拟极区技术在惯性***极区导航中的应用研究.《惯性技术发展动态发展方向研讨会文集》.2016,第69-73页. * |
Also Published As
Publication number | Publication date |
---|---|
CN110196066A (zh) | 2019-09-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110196066B (zh) | 基于格网姿态速度信息不变的虚拟极区方法 | |
AU2020103939A4 (en) | Polar Integrated Navigation Algorithm of SINS / GPS Based on Grid Framework | |
CN101344391B (zh) | 基于全功能太阳罗盘的月球车位姿自主确定方法 | |
CN110457813B (zh) | 基于横向地理坐标系的虚拟极区方法 | |
CN102809377B (zh) | 飞行器惯性/气动模型组合导航方法 | |
CN104655131B (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN102607564B (zh) | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航***初始化方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN109931955B (zh) | 基于状态相关李群滤波的捷联惯性导航***初始对准方法 | |
CN103837151B (zh) | 一种四旋翼飞行器的气动模型辅助导航方法 | |
CN103471616A (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN106871928A (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN103076015A (zh) | 一种基于全面最优校正的sins/cns组合导航***及其导航方法 | |
CN108225325B (zh) | 基于虚拟球模型的极地横向导航方法 | |
CN105203104A (zh) | 一种适用于高精度惯导***的重力场建模方法 | |
CN105737858A (zh) | 一种机载惯导***姿态参数校准方法与装置 | |
CN104913781A (zh) | 一种基于动态信息分配的非等间隔联邦滤波方法 | |
CN103017787A (zh) | 适用于摇摆晃动基座的初始对准方法 | |
CN106017460A (zh) | 一种地形辅助惯导紧组合的水下潜器导航定位方法 | |
CN111207773B (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
Whittaker et al. | Inertial navigation employing common frame error representations | |
Whittaker et al. | Linearized analysis of inertial navigation employing common frame error representations | |
Fu et al. | Unified all-Earth navigation mechanization and virtual polar region technology | |
CN103017773B (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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240422 Address after: No. 1-7, No. 25 Daxue City South Road, Shapingba District, Chongqing, 401331 Patentee after: Chongqing Science and technology Guangbo Technology Co.,Ltd. Country or region after: China Address before: 710072 No. 127 Youyi West Road, Shaanxi, Xi'an Patentee before: Northwestern Polytechnical University Country or region before: China |