CN108225325B - 基于虚拟球模型的极地横向导航方法 - Google Patents

基于虚拟球模型的极地横向导航方法 Download PDF

Info

Publication number
CN108225325B
CN108225325B CN201711475614.5A CN201711475614A CN108225325B CN 108225325 B CN108225325 B CN 108225325B CN 201711475614 A CN201711475614 A CN 201711475614A CN 108225325 B CN108225325 B CN 108225325B
Authority
CN
China
Prior art keywords
coordinate system
transverse
navigation
earth
polar
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
Application number
CN201711475614.5A
Other languages
English (en)
Other versions
CN108225325A (zh
Inventor
覃方君
常路宾
李安
查峰
佟林
王智
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Naval University of Engineering PLA
Original Assignee
Naval University of Engineering PLA
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Naval University of Engineering PLA filed Critical Naval University of Engineering PLA
Priority to CN201711475614.5A priority Critical patent/CN108225325B/zh
Publication of CN108225325A publication Critical patent/CN108225325A/zh
Application granted granted Critical
Publication of CN108225325B publication Critical patent/CN108225325B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/20—Instruments for performing navigational calculations

Abstract

本发明涉及一种基于虚拟球模型的极地横向导航方法，该方法构造了一个“虚拟球”模型，该模型可以看作是一个具有卯酉圈半径的人工球。详细推导了改进的横向极坐标导航“虚拟球”模型的姿态、速度和位置微分方程，并采用膨胀系数来补偿载体的东向速度。数值仿真结果表明，该方法不仅能很好地抑制极坐标系下位置、速度、姿态和航向的振动误差，而且可以减小速度的常值误差。简化了横向导航坐标系的转换过程，避免了基于椭球模型(WGS‑84或CGCS2000模型)的复杂横向导航方法。

Description

基于虚拟球模型的极地横向导航方法
技术领域
本发明涉及极区导航领域技术领域，具体涉及一种基于虚拟球模型的极地横向导航方法。
背景技术
极地地区已经成为人类重要的科学研究基地。随着航空和航海事业的飞速发展，科学技术的不断进步，人类的极地活动越来越频繁，极地的意义越来越重要。使得极地导航成为近年来研究的热点。惯性导航不受极性地磁变化和太阳风暴等外部条件的影响。自主性好的优点使得惯性导航成为极坐标导航的重要技术手段。由于地理子午线在极地地区迅速收敛，传统的惯性导航方法无法在极地地区获得位置和方位。参考文献，BroxmeyerC.Inertial navigation system[M].New York:McGraw-Hill,1964，提出了一种用于惯性导航的横向导航方法，传统的地理坐标系横向旋转，使原来的南北极在新坐标系中位于赤道。从理论上解决极区导航问题。在上世纪50年代，“鹦鹉螺”号核潜艇惯性导航系统(INS)使用这种导航方法完成了通过北极的任务。传统的横向导航采用球形模型地球，带来简洁和便利的地理坐标系统的横向旋转的优势。但实际上地球是一个椭球体。所以简化必然会引入惯性导航系统的误差。为了减少球形模型引起的原理误差，近年来一些学者做了一些卓有成效的研究工作。根据文献Li Qian,Sun Feng,Ben Yue-yang,et al.Polarnavigation of strapdown inertial navigation system based on transversal framein polar region[J].Journal of Chinese Inertial Technology,2014,22(3):288-295.；Li Qian,Sun Feng,Ben Yue-yang,et al.Transversal strapdown INS anddamping design in polar region[J].Systems Engineering and Electronics,2014,36(12):2496-2503.；Liu Wen-chao,Bian Hong-wei,Wang Rong-ying,et al.Navigationperformance of SINS transverse coordinate method[J].Geomatics and InformationScience of Wuhan University,2015,40(11):1520-1525.；从理论上分析了基于球体模型的横向导航的性能和误差特性。指出通过球状模型引起的原理误差主要振荡误差，将阻尼技术应用于传统惯性导航系统中，以抑制振荡误差。在文献中Qian Li,Yueyang Ben,FeiYu,et al.Transversal Strapdown INS based on Reference Ellipsoid for Vehiclein Polar Region.IEEE Transactions on Vehicular Technology.2015,1,7791-7795.；Xu Xiao-su,Dou Man.Inertial navigation algorithm in polar regions based ontransverse geographic coordinate system[J].Journal of Huazhong University ofScience and Technology(Natural Science Edition),2014,12:116-121.；Yi-qing Yao,Xiao-su Xu,Yao Li et al.Transverse Navigation under the Ellipsoidal EarthModel and its Performance in both Polar and Non-polar areas.THE JOURNAL OFNAVIGATION,2016,69,335-352，椭圆曲率半径用WGS-84地球模型来确定。而在文献QianLi,Yueyang Ben,Fei Yu,et al.Transversal Strapdown INS based on ReferenceEllipsoid for Vehicle in Polar Region.IEEE Transactions on VehicularTechnology.2015,1,7791-7795.中，椭球的曲率半径由本文中的方程(2)确定，在文献WANGHai-bo,ZHANG Han-wu,ZHANG Ping-ping,et al.Inertial navigation algorithm forpolar region based on transverse terrestrial coordinate,Journal of ChineseInertial Technology,2016,24(6):716-722.中，CGCS2000地球模型应用于极地导航的横向地球坐标系中，列出了横向椭球曲率半径的明确表达式。虽然文献中没有详细给出曲率半径的推导过程，但是其研究思路应该类似于WGS-84地球模型。但是，通过上述文献可以总结出以上方法存在的几点不足：第一，需要选取适当的椭球作为地球模型；第二，曲率半径推导和求解过于复杂；第三，导航过程比较繁琐。
发明内容
本发明的目的在于提供一种基于虚拟球模型的极地横向导航方法，该方法不仅能很好地抑制球形模型的横向极坐标法中的位置、速度、姿态和航向的振动误差，而且可以减小速度的常值误差。简化了横向导航坐标系的转换过程，避免了基于椭球模型的复杂横向导航方法(WGS-84或CGCS2000模型)。
为解决上述技术问题，本发明公开的一种基于虚拟球模型的极地横向导航方法，其特征在于，它包括如下步骤：
步骤1：将地理坐标系转换为横向导航坐标系；
地理坐标系与横向导航坐标系之间的关系如下：
Figure GDA0002263319990000031
其中，其中，(L,λ)为地球坐标系统的经纬度，(Lt,λt)为横向经纬度，横向经线是指通过两个横向极点的平面与地球交叉而形成的等高线，设P为地球表面的一个点，它的法线与横向赤道面之间的夹角Lt为P点的横向纬度，P点的横子午面与初始横子午面之间的夹角定义为P点的横向经度λt；
步骤2：确定地球椭球模型球心到地球椭球模型上任意一点的线段O'P的长度Rt'为：
Figure GDA0002263319990000032
其中，Re表示地球椭球模型长半轴的长度，Rp表示地球椭球模型短轴的长度，L'表示地球椭球模型中任意一点P的纬度，O'为地球椭球模型球心，P为地球椭球模型中任意一点；
步骤3：确定极地横向导航用虚拟球模型的半径OP＝Rt；
Figure GDA0002263319990000041
其中，L表示地球坐标系统的纬度，Re表示地球椭球模型长半轴的长度，Rp表示地球椭球模型短轴的长度，f表示地球椭球模型的椭圆扁率；
步骤4：将极地横向导航用虚拟球模型的半径采用如下公式转换到横向导航坐标系中；
Figure GDA0002263319990000042
其中，Re表示地球椭球模型长半轴的长度，f表示地球椭球模型的椭圆扁率，(Lt,λt)为横向经纬度；
步骤5：极地横向导航用虚拟球模型可看作是一个包含点P，半径为卯酉圈半径的人造球，确定极地横向导航用虚拟球模型的半径与地球的子午圈半径之间的比值k，k可由下列公式确定：
Figure GDA0002263319990000043
其中，RM为地球子午圈半径，Rt为极地横向导航用虚拟球模型的半径，f表示地球椭球模型的椭圆扁率，L表示地球坐标系统的纬度；
步骤6：确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体姿态微分方程；
Figure GDA0002263319990000051
其中，
Figure GDA0002263319990000052
为极地横向导航载体坐标系b下极地横向导航载体坐标系b相对横向导航坐标系nt的角速度；
Figure GDA0002263319990000053
为横向导航坐标系nt下横向导航坐标系nt相对地心坐标系i的角速度；
Figure GDA0002263319990000054
为横向导航坐标系nt下地球坐标系e相对地心坐标系i的角速度；
Figure GDA0002263319990000055
为极地横向导航载体坐标系b下极地横向导航载体坐标系b相对地心坐标系i的角速度；
Figure GDA0002263319990000056
横向导航坐标系nt下横向导航坐标系nt相对地球坐标系e的角速度；
Figure GDA0002263319990000057
为地球坐标系e下地球坐标系e相对地心坐标系i的角速度；
Figure GDA0002263319990000058
为从极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵；
Figure GDA0002263319990000059
为从极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵的微分，
Figure GDA0002263319990000061
为从横向导航坐标系nt到极地横向导航载体坐标系b的变换矩阵，
Figure GDA0002263319990000062
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure GDA0002263319990000063
为从地球坐标系e到横向地球坐标系t的横向旋转矩阵；
Figure GDA0002263319990000064
是与角速度矢量
Figure GDA0002263319990000065
对应的斜对称矩阵；
其中，
Figure GDA0002263319990000066
Figure GDA0002263319990000067
步骤7：确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体速度微分方程：
Figure GDA0002263319990000068
其中，
Figure GDA0002263319990000069
为横向导航坐标系nt下导航载体的速度矢量，fb为导航载体中加速度计的读数(加速度值)，
Figure GDA00022633199900000610
为横向导航坐标系nt下重力矢量，
Figure GDA00022633199900000611
为横向导航坐标系nt下横向导航坐标系nt相对横向地球坐标系t的角速度，
Figure GDA00022633199900000612
为横向导航坐标系nt下导航载体的速度矢量的微分，
Figure GDA00022633199900000613
横向导航坐标系nt下地球坐标系e相对地心坐标系i的角速度；
步骤8:确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体的位置微分方程：
Figure GDA0002263319990000071
其中，
Figure GDA0002263319990000072
为横向导航坐标系纬度的微分，
Figure GDA0002263319990000073
为横向导航坐标系经度的微分，
Figure GDA0002263319990000074
为
Figure GDA0002263319990000075
的北向速度分量，Rt为极地横向导航用虚拟球模型的半径，
Figure GDA0002263319990000076
为
Figure GDA0002263319990000077
的东向速度分量，Lt为横向导航坐标系的纬度；
步骤9：确定极地横向导航载体坐标系b下的导航与横向导航的转换关系为：
Figure GDA0002263319990000078
其中，
Figure GDA0002263319990000079
为地球坐标系e到横向地球坐标系t的旋转矩阵，
Figure GDA00022633199900000710
为导航坐标系n系到地球坐标系e的旋转矩阵，导航坐标系n(参考文献：赵桂玲.光学陀螺捷联惯性导航系统标定技术:The calibration technique of optical gyro SINS[M].测绘出版社,2014.)是根据导航系统的需要而选取的作为导航基准的坐标系，
Figure GDA00022633199900000711
为极地横向导航载体坐标系b到导航坐标系n的旋转矩阵，t0表示时刻，
Figure GDA00022633199900000712
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure GDA00022633199900000713
为极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵；
步骤10：确定载体北向速度，将步骤9中的
Figure GDA0002263319990000081
代入公式13：
Figure GDA0002263319990000082
其中，k(膨胀系数k)为极地横向导航用虚拟球模型的半径与地球的子午圈半径之间的比值,K＝[1 0 0；0 k 0；0 0 1]，K为膨胀系数矩阵，
Figure GDA0002263319990000083
为极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵，
Figure GDA0002263319990000084
为导航坐标系n到极地横向导航载体坐标系b的横向旋转矩阵，
Figure GDA0002263319990000085
为导航坐标系n到横向导航坐标系nt的旋转矩阵，
Figure GDA0002263319990000086
为横向导航坐标系nt下导航载体的速度矢量，Vn为导航坐标系n下导航载体的速度矢量。
本发明摒弃了复杂的求解椭球半径的思想，提出了一种新的极坐标法。通过在载体所在的地方构建一个极地横向导航用虚拟球模型，我们将地球从椭球转换成球体。这样就可以更容易地横向转动坐标系。详细推导了利用极地横向导航用虚拟球模型进行改进的横向极坐标导航的基本方程，膨胀系数补偿载体的东方速度。数值模拟结果表明，该方法不仅能很好地抑制球形模型的横向极坐标法中的位置、速度、姿态和航向的振动误差，而且可以减小速度的常值误差。简化了横向导航坐标系的转换过程，避免了基于椭球模型的复杂横向导航方法(WGS-84或CGCS2000模型)。椭球模型的选取、复杂的横向椭球半径的推导和求解都略去了。
传统的横向导航使用地球的球形模型，虽然坐标系的横向旋转带来了方便和简便，但简化的地球模型必须引入明显的原理误差，这对于高精度惯性导航系统来说是不可接受的。为了减少球面模型引起的误差，本发明提出了一种新的横向导航方法,总的来说本发明的主要特点和优势如下：
1、本发明将传统的地理坐标系横向旋转，将原来的地理南北极转换为新坐标系的赤道，由于地理子午线在极地地区迅速收敛，传统的惯性导航方法无法在极地地区获得位置和方位。惯性导航的横向导航方法，将传统的地理坐标系横向旋转，使原来的南北极在新坐标系中位于赤道。在此基础上，从理论上解决极区导航问题。
2、本发明通过在载体所在的位置构建极地横向导航用虚拟球模型，坐标系可以很容易地旋转。
3、本发明可以简化横向导航坐标系的转换过程，避免了基于椭球模型(WGS-84模型或CGCS2000模型)的复杂的横向导航方法。完全不需要椭球模型的选取，复杂的横向椭球半径的推导和求解。
4、本发明不仅可以明显地抑制球面模型中位置，速度，姿态和航向的振动误差，而且可以减小速度的常值误差。
附图说明
图1为横向导航坐标系统。
图2为极地横向导航用虚拟球模型的示意图。
图3a为传统圆球模型与极地横向导航用虚拟球模型的纬度误差。
图3b为传统圆球模型与极地横向导航用虚拟球模型的精度误差。
图4a为传统圆球模型与极地横向导航用虚拟球模型的东向速度误差。
图4b为传统圆球模型与极地横向导航用虚拟球模型的4b北向速度误差。
图5a为传统圆球模型与极地横向导航用虚拟球模型的俯仰角误差。
图5b为传统圆球模型与极地横向导航用虚拟球模型的横滚角误差；
图5c为传统圆球模型与极地横向导航用虚拟球模型的航向角误差；
图1中，横向导航坐标系为nt，它的原点为载体的位置，Et轴沿着横向纬度线切线向东的方向，Nt轴沿着横向经线切线向东的方向，Ut轴沿着球体向天顶的法线方向。Et、Nt和Ut轴互相垂直。
图2中O坐标系原点，虚拟球模型中地球的中心；O′坐标系原点，地球椭球模型中地球的中心。
图3a中横坐标表示时间，纵坐标表示纬度误差；图3b中横坐标表示时间，纵坐标表示经度误差；图4a中横坐标表示时间，纵坐标表示东向速度误差；图4b中横坐标表示时间，纵坐标表示北向速度误差；图5a中横坐标表示时间，纵坐标表示俯仰角误差；图5b中横坐标表示时间，纵坐标表示横滚角误差；图5c中横坐标表示时间，纵坐标表示航向角误差。
具体实施方式
以下结合附图和具体实施例对本发明作进一步的详细说明：
本发明的一种基于虚拟球模型的极地横向导航方法，其特征在于，它包括如下步骤：
步骤1：将地理坐标系转换为横向导航坐标系；
地理坐标系与横向导航坐标系之间的关系如下：
Figure GDA0002263319990000101
其中，其中，(L,λ)为地球坐标系统的经纬度，(Lt,λt)为横向经纬度，横向经线是指通过两个横向极点的平面与地球交叉而形成的等高线，设P为地球表面的一个点，它的法线与横向赤道面之间的夹角Lt为P点的横向纬度，P点的横子午面与初始横子午面之间的夹角定义为P点的横向经度λt；
步骤2：确定地球椭球模型球心到地球椭球模型上任意一点的线段O'P的长度Rt'为：
Figure GDA0002263319990000111
其中，Re表示地球椭球模型长半轴的长度，Rp表示地球椭球模型短轴的长度，L'表示地球椭球模型中任意一点P的纬度，O'为地球椭球模型球心，P为地球椭球模型中任意一点；
步骤3：确定极地横向导航用虚拟球模型的半径OP＝Rt；
Figure GDA0002263319990000112
其中，L表示地球坐标系统的纬度，Re表示地球椭球模型长半轴的长度，Rp表示地球椭球模型短轴的长度，f表示地球椭球模型的椭圆扁率；
步骤4：将极地横向导航用虚拟球模型的半径采用如下公式转换到横向导航坐标系中；
Figure GDA0002263319990000113
其中，Re表示地球椭球模型长半轴的长度，f表示地球椭球模型的椭圆扁率，(Lt,λt)为横向经纬度；
步骤5：极地横向导航用虚拟球模型可看作是一个包含点P，半径为卯酉圈半径的人造球，确定极地横向导航用虚拟球模型的半径与地球的子午圈半径之间的比值k，k可由下列公式确定：
Figure GDA0002263319990000121
其中，RM为地球子午圈半径，Rt为极地横向导航用虚拟球模型的半径，f表示地球椭球模型的椭圆扁率，L表示地球坐标系统的纬度；
步骤6：确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体姿态微分方程；
Figure GDA0002263319990000122
其中，
Figure GDA0002263319990000123
为极地横向导航载体坐标系b下极地横向导航载体坐标系b相对横向导航坐标系nt的角速度；
Figure GDA0002263319990000124
为横向导航坐标系nt下横向导航坐标系nt相对地心坐标系i的角速度；
Figure GDA0002263319990000125
为横向导航坐标系nt下地球坐标系e相对地心坐标系i的角速度；
Figure GDA0002263319990000126
为极地横向导航载体坐标系b下极地横向导航载体坐标系b相对地心坐标系i的角速度；
Figure GDA0002263319990000127
横向导航坐标系nt下横向导航坐标系nt相对地球坐标系e的角速度；
Figure GDA0002263319990000128
为地球坐标系e下地球坐标系e相对地心坐标系i的角速度；
Figure GDA0002263319990000129
为从极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵；
Figure GDA0002263319990000131
为从极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵的微分，
Figure GDA0002263319990000132
为从横向导航坐标系nt到极地横向导航载体坐标系b的变换矩阵，
Figure GDA0002263319990000133
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure GDA0002263319990000134
为从地球坐标系e到横向地球坐标系t的横向旋转矩阵；
Figure GDA0002263319990000135
是与角速度矢量
Figure GDA0002263319990000136
对应的斜对称矩阵；
其中，
Figure GDA0002263319990000137
Figure GDA0002263319990000138
步骤7：确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体速度微分方程：
Figure GDA0002263319990000139
其中，
Figure GDA00022633199900001310
为横向导航坐标系nt下导航载体的速度矢量，fb为导航载体中加速度计的读数，
Figure GDA00022633199900001311
为横向导航坐标系nt下重力矢量，
Figure GDA00022633199900001312
为横向导航坐标系nt下横向导航坐标系nt相对横向地球坐标系t的角速度，
Figure GDA00022633199900001313
为横向导航坐标系nt下导航载体的速度矢量的微分，
Figure GDA00022633199900001314
横向导航坐标系nt下地球坐标系e相对地心坐标系i的角速度；
步骤8:确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体的位置微分方程：
Figure GDA0002263319990000141
其中，
Figure GDA0002263319990000142
为横向导航坐标系纬度的微分，
Figure GDA0002263319990000143
为横向导航坐标系经度的微分，
Figure GDA0002263319990000144
为
Figure GDA0002263319990000145
的北向速度分量，Rt为极地横向导航用虚拟球模型的半径，
Figure GDA0002263319990000146
为
Figure GDA0002263319990000147
的东向速度分量，Lt为横向导航坐标系的纬度；
步骤9：确定极地横向导航载体坐标系b下的导航与横向导航的转换关系为：
Figure GDA0002263319990000148
其中，
Figure GDA0002263319990000149
为地球坐标系e到横向地球坐标系t的旋转矩阵，
Figure GDA00022633199900001410
为导航坐标系n系到地球坐标系e的旋转矩阵，导航坐标系n(参考文献：赵桂玲.光学陀螺捷联惯性导航系统标定技术:The calibration technique of optical gyro SINS[M].测绘出版社,2014.)是根据导航系统的需要而选取的作为导航基准的坐标系，
Figure GDA00022633199900001411
为极地横向导航载体坐标系b到导航坐标系n的旋转矩阵，t0表示时刻，
Figure GDA00022633199900001412
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure GDA00022633199900001413
为极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵；
步骤10：确定载体北向速度，将步骤9中的
Figure GDA0002263319990000151
代入公式13：
Figure GDA0002263319990000152
其中，k为极地横向导航用虚拟球模型的半径与地球的子午圈半径之间的比值,K＝[1 0 0；0 k 0；0 0 1]，K为膨胀系数矩阵，
Figure GDA0002263319990000153
为极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵，
Figure GDA0002263319990000154
为导航坐标系n到极地横向导航载体坐标系b的横向旋转矩阵，
Figure GDA0002263319990000155
为导航坐标系n到横向导航坐标系nt的旋转矩阵，
Figure GDA0002263319990000156
为横向导航坐标系nt下导航载体的速度矢量，Vn为导航坐标系n下导航载体的速度矢量。
上述技术方案中，步骤6中，
Figure GDA0002263319990000157
与极地横向导航用虚拟球模型的半径密切相关，由如下公式决定：
Figure GDA0002263319990000158
其中，
Figure GDA0002263319990000159
为横向导航坐标系nt下横向导航坐标系nt相对横向地球坐标系t的角速度，
Figure GDA00022633199900001510
为横向地球坐标系t下载体的北向速度，
Figure GDA00022633199900001511
为横向地球坐标系t下载体的东向速度，Lt横向导航坐标系的纬度，Rt为极地横向导航用虚拟球模型的半径。
上述技术方案中，所述步骤3中的O'P＝Rt'与OP＝Rt的关系为Rt＝Rt'cosL'/cosL。
上述技术方案中，所述步骤4中的有如下关系：
Figure GDA0002263319990000161
其中，(L,λ)为地球经纬度，(x,y,z)为地球坐标系中地球表面上的点，Re表示地球椭球模型长半轴的长度，f表示地球椭球模型的椭圆扁率。
上述技术方案中，所述步骤7中，横向导航坐标系nt的z轴定义为指向天向且
Figure GDA0002263319990000162
g为重力加速度，T为矩阵转置符号。
上述技术方案中，所述步骤9中的
Figure GDA0002263319990000163
由转换时刻的常规导航提供，
Figure GDA0002263319990000164
和
Figure GDA0002263319990000165
由转换时刻的经度和纬度确定，如下式所示：
Figure GDA0002263319990000166
其中，T为矩阵转置符号，(L,λ)为地球坐标系统的经纬度，(Lt,λt)为横向导航坐标系的经纬度，
Figure GDA0002263319990000167
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure GDA0002263319990000168
为导航坐标系n系到地球坐标系e的旋转矩阵。
为了验证基于“虚拟球体”的惯导系统导航方案的可行性和有效性，将轨迹发生器设计如下：
步骤100：初始地理位置为(70°N，0°)，东向速度和北向速度均为6m/s；
步骤200：角速度ω＝2π/3600(rad/s)、载体运动的幅度H分别设为1m、5m、10m、15m、20m，表示为H1＝1,H2＝5,H3＝10,H4＝15,H5＝20，H1到H5表示H的五次取值；
步骤300：将运载体的运动设置为H·sin(ω·t)，t为时间，垂向速度为H·ω·cos(ω·t)，将步骤200中的ω、H代入；
步骤400：航向角设置为45°，横滚角设置为5°sin(πt/4)弧度，俯仰角设置为3°cos(πt/5)弧度；仿真周期为36小时。
仿真结果表明，采用球面地球模型的传统横向导航存在明显的误差，主要表现为振动误差形式。从图3可以看出。在不考虑惯性传感器的误差的情况下，36小时内位置误差的最大振幅接近0.03nmile(约55m)。随着惯性传感器误差的耦合，误差会进一步变大。对于高精度的惯性导航系统，这个误差是完全不能接受的。本文所提出的极地横向导航用虚拟球模型对抑制振荡误差有显著效果。另外，本发明也可以显着减少东方速度误差和北方速度误差的常值误差。
表1为不同模型的横向导航误差(STD)
Figure GDA0002263319990000181
本说明书未作详细描述的内容属于本领域专业技术人员公知的现有技术。

Claims (6)

1.一种基于虚拟球模型的极地横向导航方法，其特征在于，它包括如下步骤：
步骤1：将地理坐标系转换为横向导航坐标系；
地理坐标系与横向导航坐标系之间的关系如下：
Figure FDA0002274747970000011
其中，(L,λ)为地球坐标系统的经纬度，L表示地球坐标系统的纬度，λ表示地球坐标系统的经度，(Lt,λt)为横向经纬度，横向经线是指通过两个横向极点的平面与地球交叉而形成的等高线，设P为地球表面的一个点，它的法线与横向赤道面之间的夹角Lt为P点的横向纬度，P点的横子午面与初始横子午面之间的夹角定义为P点的横向经度λt；
步骤2：确定地球椭球模型球心到地球椭球模型上任意一点的线段O'P的长度Rt'为：
Figure FDA0002274747970000012
其中，Re表示地球椭球模型长半轴的长度，Rp表示地球椭球模型短轴的长度，L'表示地球椭球模型中任意一点P的纬度，O'为地球椭球模型球心，P为地球椭球模型中任意一点；
步骤3：确定极地横向导航用虚拟球模型的半径OP＝Rt；
Figure FDA0002274747970000013
其中，L表示地球坐标系统的纬度，Re表示地球椭球模型长半轴的长度，Rp表示地球椭球模型短轴的长度，f表示地球椭球模型的椭圆扁率；
步骤4：将极地横向导航用虚拟球模型的半径采用如下公式转换到横向导航坐标系中；
Figure FDA0002274747970000021
其中，Re表示地球椭球模型长半轴的长度，f表示地球椭球模型的椭圆扁率，(Lt,λt)为横向经纬度；
步骤5：极地横向导航用虚拟球模型可看作是一个包含点P，半径为卯酉圈半径的人造球，确定极地横向导航用虚拟球模型的半径与地球的子午圈半径之间的比值k，k可由下列公式确定：
Figure FDA0002274747970000022
其中，RM为地球子午圈半径，Rt为极地横向导航用虚拟球模型的半径，f表示地球椭球模型的椭圆扁率，L表示地球坐标系统的纬度；
步骤6：确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体姿态微分方程；
Figure FDA0002274747970000023
其中，
Figure FDA0002274747970000024
为极地横向导航载体坐标系b下极地横向导航载体坐标系b相对横向导航坐标系nt的角速度；
Figure FDA0002274747970000031
为横向导航坐标系nt下横向导航坐标系nt相对地心坐标系i的角速度；
Figure FDA0002274747970000032
为横向导航坐标系nt下地球坐标系e相对地心坐标系i的角速度；
Figure FDA0002274747970000033
为极地横向导航载体坐标系b下极地横向导航载体坐标系b相对地心坐标系i的角速度；
Figure FDA0002274747970000034
横向导航坐标系nt下横向导航坐标系nt相对地球坐标系e的角速度；
Figure FDA0002274747970000035
为地球坐标系e下地球坐标系e相对地心坐标系i的角速度；
Figure FDA0002274747970000036
为从极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵；
Figure FDA0002274747970000037
为从极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵的微分，
Figure FDA0002274747970000038
为从横向导航坐标系nt到极地横向导航载体坐标系b的变换矩阵，
Figure FDA0002274747970000039
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure FDA00022747479700000310
为从地球坐标系e到横向地球坐标系t的横向旋转矩阵；
Figure FDA00022747479700000311
是与角速度矢量
Figure FDA00022747479700000312
对应的斜对称矩阵；
其中，
Figure FDA00022747479700000313
Figure FDA00022747479700000314
步骤7：确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体速度微分方程：
Figure FDA0002274747970000041
其中，
Figure FDA0002274747970000042
为横向导航坐标系nt下导航载体的速度矢量，fb为导航载体的加速度值，
Figure FDA0002274747970000043
为横向导航坐标系nt下重力矢量，
Figure FDA0002274747970000044
为横向导航坐标系nt下横向导航坐标系nt相对横向地球坐标系t的角速度，
Figure FDA0002274747970000045
为横向导航坐标系nt下导航载体的速度矢量的微分，
Figure FDA0002274747970000046
横向导航坐标系nt下地球坐标系e相对地心坐标系i的角速度；
Figure FDA0002274747970000047
为从极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵；
步骤8:确定横向导航坐标系nt下基于极地横向导航用虚拟球模型的极地横向导航载体的位置微分方程：
Figure FDA0002274747970000048
其中，
Figure FDA0002274747970000049
为横向导航坐标系纬度的微分，
Figure FDA00022747479700000410
为横向导航坐标系经度的微分，
Figure FDA00022747479700000411
为
Figure FDA00022747479700000412
的北向速度分量，Rt为极地横向导航用虚拟球模型的半径，
Figure FDA00022747479700000413
为
Figure FDA00022747479700000414
的东向速度分量，Lt为横向导航坐标系的纬度；
步骤9：确定极地横向导航载体坐标系b下的导航与横向导航的转换关系为：
Figure FDA0002274747970000051
其中，
Figure FDA0002274747970000052
为地球坐标系e到横向地球坐标系t的旋转矩阵，
Figure FDA0002274747970000053
为导航坐标系n系到地球坐标系e的旋转矩阵，导航坐标系n是根据导航系统的需要而选取的作为导航基准的坐标系，
Figure FDA0002274747970000054
为极地横向导航载体坐标系b到导航坐标系n的旋转矩阵，t0表示时刻，
Figure FDA0002274747970000055
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure FDA0002274747970000056
为极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵；
步骤10：确定载体北向速度，将步骤9中的
Figure FDA0002274747970000057
代入公式12：
Figure FDA0002274747970000058
其中，k为极地横向导航用虚拟球模型的半径与地球的子午圈半径之间的比值,K＝[10 0；0 k 0；0 0 1]，K为膨胀系数矩阵，
Figure FDA0002274747970000059
为极地横向导航载体坐标系b到横向导航坐标系nt的变换矩阵，
Figure FDA00022747479700000510
为导航坐标系n到极地横向导航载体坐标系b的横向旋转矩阵，
Figure FDA00022747479700000511
为导航坐标系n到横向导航坐标系nt的旋转矩阵，
Figure FDA00022747479700000512
为横向导航坐标系nt下导航载体的速度矢量，Vn为导航坐标系n下导航载体的速度矢量。
2.根据权利要求1所述的基于虚拟球模型的极地横向导航方法，其特征在于：步骤6中，
Figure FDA0002274747970000061
与极地横向导航用虚拟球模型的半径密切相关，由如下公式决定：
Figure FDA0002274747970000062
其中，
Figure FDA0002274747970000063
为横向导航坐标系nt下横向导航坐标系nt相对横向地球坐标系t的角速度，
Figure FDA0002274747970000064
为横向地球坐标系t下载体的北向速度，
Figure FDA0002274747970000065
为横向地球坐标系t下载体的东向速度，Lt横向导航坐标系的纬度，Rt为极地横向导航用虚拟球模型的半径，T为矩阵转置符号。
3.根据权利要求1所述的基于虚拟球模型的极地横向导航方法，其特征在于：所述步骤3中的O'P＝Rt'与OP＝Rt的关系为Rt＝Rt'cosL'/cosL。
4.根据权利要求1所述的基于虚拟球模型的极地横向导航方法，其特征在于：所述步骤4有如下关系：
Figure FDA0002274747970000066
其中，(L,λ)为地球经纬度，(x,y,z)为地球坐标系中地球表面上的点，Re表示地球椭球模型长半轴的长度，f表示地球椭球模型的椭圆扁率。
5.根据权利要求1所述的基于虚拟球模型的极地横向导航方法，其特征在于：所述步骤7中，横向导航坐标系nt的z轴定义为指向天向且
Figure FDA0002274747970000071
g为重力加速度，T为矩阵转置符号。
6.根据权利要求1所述的基于虚拟球模型的极地横向导航方法，其特征在于：所述步骤9中的
Figure FDA0002274747970000072
由转换时刻的常规导航提供，
Figure FDA0002274747970000073
和
Figure FDA0002274747970000074
由转换时刻的经度和纬度确定，如下式所示：
Figure FDA0002274747970000075
其中，T为矩阵转置符号，(L,λ)为地球坐标系统的经纬度，(Lt,λt)为横向导航坐标系的经纬度，
Figure FDA0002274747970000076
为横向地球坐标系t到横向导航坐标系nt的旋转矩阵，
Figure FDA0002274747970000077
为导航坐标系n系到地球坐标系e的旋转矩阵。
CN201711475614.5A 2017-12-29 2017-12-29 基于虚拟球模型的极地横向导航方法 Active CN108225325B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711475614.5A CN108225325B (zh) 2017-12-29 2017-12-29 基于虚拟球模型的极地横向导航方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711475614.5A CN108225325B (zh) 2017-12-29 2017-12-29 基于虚拟球模型的极地横向导航方法

Publications (2)

Publication Number Publication Date
CN108225325A CN108225325A (zh) 2018-06-29
CN108225325B true CN108225325B (zh) 2020-04-17

Family

ID=62645995

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711475614.5A Active CN108225325B (zh) 2017-12-29 2017-12-29 基于虚拟球模型的极地横向导航方法

Country Status (1)

Country Link
CN (1) CN108225325B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110196066B (zh) * 2019-05-10 2022-07-15 西北工业大学 基于格网姿态速度信息不变的虚拟极区方法
CN110457813B (zh) * 2019-08-08 2022-07-05 西北工业大学 基于横向地理坐标系的虚拟极区方法
CN111928848B (zh) * 2020-09-24 2020-12-18 中国人民解放军国防科技大学 一种基于虚拟圆球法向量模型的极区惯性导航方法
CN113124879A (zh) * 2021-04-23 2021-07-16 苏州大学 虚拟圆球模型下sins/dvl极区组合导航方法及系统
CN117470233A (zh) * 2023-11-10 2024-01-30 中国人民解放军国防科技大学 一种优化的地球椭球模型下横坐标系组合导航方法
CN117470235B (zh) * 2023-11-10 2024-04-26 中国人民解放军国防科技大学 一种优化的地球椭球模型下长航时跨极区阻尼切换方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0431997A1 (fr) * 1989-11-17 1991-06-12 AEROSPATIALE Société Nationale Industrielle Procédé visualisation de l'attitude d'un aeronef, pour l'aide au pilotage dans l'espace
CN103411610A (zh) * 2013-07-29 2013-11-27 哈尔滨工程大学 一种惯性导航系统极区模式横地理纬度初始值的测量方法
CN103528584A (zh) * 2013-11-04 2014-01-22 东南大学 基于横向地理坐标系的极区惯性导航方法
CN103940446A (zh) * 2014-04-10 2014-07-23 哈尔滨工程大学 一种基于横坐标系的极区航行船舶捷联惯性导航系统重调方法
CN104215242A (zh) * 2014-09-30 2014-12-17 东南大学 一种基于横向游移坐标系的极区惯性导航方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0431997A1 (fr) * 1989-11-17 1991-06-12 AEROSPATIALE Société Nationale Industrielle Procédé visualisation de l'attitude d'un aeronef, pour l'aide au pilotage dans l'espace
CN103411610A (zh) * 2013-07-29 2013-11-27 哈尔滨工程大学 一种惯性导航系统极区模式横地理纬度初始值的测量方法
CN103528584A (zh) * 2013-11-04 2014-01-22 东南大学 基于横向地理坐标系的极区惯性导航方法
CN103940446A (zh) * 2014-04-10 2014-07-23 哈尔滨工程大学 一种基于横坐标系的极区航行船舶捷联惯性导航系统重调方法
CN104215242A (zh) * 2014-09-30 2014-12-17 东南大学 一种基于横向游移坐标系的极区惯性导航方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Improved Transversal Polar Navigation Mechanism for Strapdown INS using Ellipsoidal Earth Model;Fangjun Qin,et al.;《THE JOURNAL OF NAVIGATION》;20181130;第71卷(第6期);1-17 *
Transversal Strapdown INS Based on Reference Ellipsoid for Vehicle in the Polar Region;Qian Li，et al.;《IEEE Transactions on Vehicular Technology》;20160930;第65卷(第9期);7791-7795 *
基于横坐标系的捷联惯性导航系统_多普勒速度仪极区组合导航算法;张福斌等;《兵工学报》;20160731;第37卷(第7期);1229-1235 *

Also Published As

Publication number Publication date
CN108225325A (zh) 2018-06-29

Similar Documents

Publication Publication Date Title
CN108225325B (zh) 基于虚拟球模型的极地横向导航方法
CN110457813B (zh) 基于横向地理坐标系的虚拟极区方法
CN103245360B (zh) 晃动基座下的舰载机旋转式捷联惯导系统自对准方法
CN104848860B (zh) 一种敏捷卫星成像过程姿态机动规划方法
CN108426575B (zh) 用地球椭球模型改进的捷联惯导极地横向导航方法
CN104165640B (zh) 基于星敏感器的近空间弹载捷联惯导系统传递对准方法
CN111928848B (zh) 一种基于虚拟圆球法向量模型的极区惯性导航方法
CN108871326B (zh) 一种单轴旋转调制惯性-天文深组合导航方法
Yao et al. Transverse Navigation under the Ellipsoidal Earth Model and its Performance in both Polar and Non-polar areas
CN110196066B (zh) 基于格网姿态速度信息不变的虚拟极区方法
CN110057382A (zh) 一种基于发射坐标系的捷联惯导数值更新方法
CN113108783B (zh) 一种无人潜航器惯性/多普勒组合导航方法
CN109425339A (zh) 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法
CN115200574A (zh) 一种地球椭球模型下的极区横向组合导航方法
CN105841698A (zh) 一种无需调零的auv舵角精确实时测量系统
CN109752000A (zh) 一种mems双轴旋转调制型捷联罗经初始对准方法
CN113050143B (zh) 一种发射惯性坐标系下的紧耦合导航方法
CN111722295B (zh) 一种水下捷联式重力测量数据处理方法
Qin et al. Improved transversal polar navigation mechanism for strapdown INS using ellipsoidal Earth model
CN110514200B (zh) 一种惯性导航系统及高转速旋转体姿态测量方法
CN104501809B (zh) 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法
CN112179334A (zh) 基于两步Kalman滤波的星光导航方法及系统
CN105928519B (zh) 基于ins惯性导航与gps导航以及磁力计的导航算法
CN105606093A (zh) 基于重力实时补偿的惯性导航方法及装置
CN110388942B (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