CN113155125A - 一种大飞机ins/gnss全球组合导航方法 - Google Patents
一种大飞机ins/gnss全球组合导航方法 Download PDFInfo
- Publication number
- CN113155125A CN113155125A CN202110502705.3A CN202110502705A CN113155125A CN 113155125 A CN113155125 A CN 113155125A CN 202110502705 A CN202110502705 A CN 202110502705A CN 113155125 A CN113155125 A CN 113155125A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- grid
- error
- representing
- delta
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000006243 chemical reaction Methods 0.000 claims abstract description 65
- 239000011159 matrix material Substances 0.000 claims abstract description 33
- 230000008569 process Effects 0.000 claims abstract description 10
- 238000012937 correction Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000009897 systematic effect Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims 1
- 238000001914 filtration Methods 0.000 abstract description 6
- 238000013461 design Methods 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000024703 flight behavior Effects 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000010792 warming Methods 0.000 description 1
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
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- 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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
Abstract
本发明属于导航技术领域,公开了一种大飞机INS/GNSS全球组合导航方法,适用于大飞机全球飞行导航。本发明以地理坐标系、格网坐标系下的组合导航滤波器为基础,并基于空间直角坐标表示大飞机在高纬度地区的位置,以此建立了***误差状态及其协方差矩阵在两个导航坐标系之间的转换关系,设计了滤波状态稳定的组合导航滤波器,解决了坐标系转换过程中的滤波状态跳变问题,并实现位置坐标在高纬度地区的平滑输出,满足了大飞机的全球飞行需求。
Description
技术领域
本发明属于导航技术领域,涉及INS/GNSS组合导航方法,特别涉及一种大飞机INS/GNSS全球组合导航方法,适用于大飞机全球飞行导航。
背景技术
近年来,随着大飞机制造业的不断进步,大飞机正逐步具备全球飞行能力,能够完成全球不同区域、不同纬度地区的飞行,这就对大飞机的全球导航能力提出了要求。另一方面,随着近年来全球气候变暖及人类对两极地区探索的逐步加强,包含高纬度地区在内的大圆飞行为飞行航线优化设计提供了更多可能,飞机的大圆航线能够有效降低燃油消耗,这对于环境保护具有十分重要的意义。
为了保证大飞机的全球导航能力,需要借助多种导航手段,目前比较常用的手段是Inertial Navigation System/Global Navigaiton Satellite System(INS/GNSS)组合导航***。惯性导航具有自主性强的特点,但其误差随着导航时间的增长而发散;卫星导航具有长期定位精度高、误差不累积的特点,但其易受干扰,不具有自主性。惯性导航与卫星导航构成组合导航***能够充分利用两种导航手段的优点,因此备受航空飞行器青睐。大飞机出现之前,由于对全球导航能力的要求不高,INS/GNSS组合导航***只需要具备中低纬度地区的导航能力即可,无需考虑高纬度地区导航能力。而目前,大飞机全球飞行能力发展的需求对现有的INS/GNSS组合导航***的提出了新要求,但考虑到INS/GNSS组合导航***的服役周期,尚不能将已装备的INS/GNSS组合导航***完全替换,需要以比较小的代价实现现有***的升级改造。
一段时间以来,国内外诸多机构、学者对大飞机全球导航方法进行了研究,但目前的研究主要关注的还是在高纬度地区的区域导航能力,忽视了大飞机飞行过程的连续性,事实上导航过程也需要在全球的不同地区之间转换。目前,在中低纬度地区,大飞机组合导航算法一般在当地水平地理坐标系下设计,在高纬度地区一般在格网坐标系下设计。当大飞机在两个地区之间连续飞行时,组合导航算法需要在不同坐标系之间转换,以实现组合导航滤波器的一致估计,避免滤波状态震荡,而这正是现有方法忽视的地方。
本发明针对目前存在的问题,提出一种大飞机INS/GNSS全球组合导航方法,以地理坐标系、格网坐标系下的组合导航滤波器为基础,并基于空间直角坐标表示大飞机在高纬度地区的位置,以此建立了***误差状态及其协方差矩阵在两个导航坐标系之间的转换关系,设计了滤波状态稳定的组合导航滤波器,解决了坐标系转换过程中的滤波状态跳变问题,并实现位置坐标在高纬度地区的平滑输出,满足了大飞机的全球飞行需求。
发明内容
本发明要解决的技术问题就在于:解决大飞机全球飞行过程中导航坐标系转换导致的滤波不稳定问题,实现***误差状态的平滑过渡,提高导航精度,为大飞机安全可靠飞行提供更加准确的导航信息。
为解决上述技术问题,本发明提出的解决方案为:
一种大飞机INS/GNSS全球组合导航方法,包括以下步骤:
(1)确定大飞机高纬度飞行区域的导航坐标系及位置表示方式,包括如下步骤:
(1.1)确定大飞机高纬度地区飞行时的导航坐标系,高纬度地区导航坐标系确定为格网坐标系,其中,格网坐标系的定义为:格网平面平行于格林尼治子午面,其与大飞机位置点处切平面的交线为格网北向,地理北向与格网北向的夹角为格网角,以顺时针为正;格网天向与当地地理坐标系天向相同,其与格网东向、北向一起构成右手直角坐标系;将格网角σ表示为
其中,表示L当地纬度,λ表示当地经度;
(1.2)将大飞机在地球坐标系e下的位置p表示为直角坐标(x,y,z);
(2)确定大飞机在格网坐标系下的更新方程,包括姿态更新方程、速度更新方程、位置更新方程,具体实施如下:
(2.1)确定格网坐标系下的姿态更新方程为:
(2.2)确定格网坐标系下的速度vG的更新方程为:
其中,
式中,fb表示载体坐标系下表示的比力,gG表示格网坐标系下表示的重力矢量,表示地球坐标系相对于惯性坐标系的旋转角速度在格网坐标系下的投影,表示格网坐标系相对于地球坐标系的旋转角速度在格网坐标系下的投影,表示地球坐标系相对于惯性坐标系的旋转角速度在地球坐标系下的投影,ωie表示地球旋转角速度,Rx为格网东向的曲率半径,Ry为格网北向的曲率半径,τf为扭曲半径,表示格网东向速度,表示格网北向速度;
(2.3)确定格网坐标系下的位置更新方程为:
(3)确定大飞机在格网坐标系下的姿态误差方程、速度误差方程、位置误差方程,具体实施如下:
确定姿态误差φG的方程如下:
确定速度误差δvG的方程如下:
确定位置误差δp的方程如下:
(4)确定大飞机导航参数在地理坐标系与格网坐标系之间的转换关系并进行转换,导航参数的转换包括姿态转换、速度转换、位置转换;
其中,大飞机姿态参数在地理坐标系、格网坐标系之间的转换关系为:
大飞机速度参数在地理坐标系、格网坐标系之间的转换关系为:
式中,vn表示地理坐标系下表示的速度;
大飞机位置参数在格网坐标系、地理坐标系之间的转换关系为:
式中,RN为卯酉圈曲率半径,f为椭圆扁率,h为大飞机相对于水平面的高度;
离开高纬度地区时,纬度、经度、高度通过迭代近似逼近求解,包括初始化与迭代计算两个步骤,首先初始化如下:
h=0
RN=Re
式中,Re表示地球长半轴;
初始化结束后,按照如下过程迭代计算:
L=arctan([z+e2RNsinL]/R)
式中,e表示椭圆偏心率;
迭代计算3~4次即满足精度要求;
(5)完成INS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中INS/GNSS组合导航滤波器采用闭环反馈校正方式,具体实施如下:
(5.1)分别确定地理坐标系与格网坐标系下的***误差状态为:
地理坐标系下的***误差状态xn(t)为
格网坐标系下的***误差状态xG(t)为
其中,分别表示地理坐标系下表示的东向、北向、垂向姿态误差,分别表示格网坐标系下表示的东向、北向、垂向姿态误差,分别表示地理坐标系下表示的东向、北向、垂向速度误差,分别表示格网坐标系下表示的东向、北向、垂向速度误差,δL,δλ分别表示纬度、经度误差,δx,δy,δz分别表示直角坐标x,y,z的误差,分别表示x、y、z轴向陀螺常值零偏,分别表示x、y、z轴向加表常值零偏,分别表示INS相对于GNSS天线在x,y,z三个方向的安装杆臂;
(5.2)分别确定姿态误差、速度误差、位置误差在地理坐标系与格网坐标系下间的转换关系为:
首先确定地理坐标系下姿态误差φn与格网坐标系下姿态误差φG之间的转换关系
式中,
其次确定地理坐标系下速度误差δvn与格网坐标系下速度误差δvG之间的转换关系
进而确定纬度误差δL、经度误差δλ、高度误差δh与直角坐标位置误差(δx,δy,δz)的转换关系
(5.3)根据步骤(5.2),确定地理坐标系下***误差状态协方差矩阵Pn(t)与格网坐标系下***误差状态协方差矩阵PG(t)的转换关系:
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,δx,δy,δz与δL、δλ、δh之间的转换关系,并考虑陀螺常值零偏加表常值零偏安装杆臂误差在地理坐标系与格网坐标系下的不变性进行确定;
(5.4)当大飞机在中纬度、高纬度地区连续飞行时,闭环反馈INS/GNSS组合导航滤波器完成在地理坐标系与格网坐标系之间的协方差矩阵转换,转换方式按照步骤(5.3)所述,鉴于***误差状态在每次闭环反馈校正后为0,其不需要转换。
进一步的,所述步骤(4)中导航参数在地理坐标系与格网坐标系之间转换时基于转换时刻的纬度阈值判断,且地理坐标系转换到格网坐标系、格网坐标系转换到地理坐标系两种情况下的阈值设定不同。
进一步的,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS速度信息,即在中低纬度的观测量为地理坐标系下速度误差δvn,在高纬度的观测量为格网坐标系下速度误差δvG。
进一步的,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS位置信息,即在中低纬度以δL,δλ,δh为观测量,在高纬度以δx,δy,δz为观测量。
进一步的,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS速度信息、位置信息,即在中低纬度的观测量为地理坐标系下速度误差δvn及位置误差δL,δλ,δh,在高纬度的观测量为格网坐标系下速度误差δvG及位置误差δx,δy,δz。
特别的,在高纬度地区,若GNSS输出的直角坐标(x,y,z),则直接观测位置误差δx,δy,δz;若GNSS输出球面坐标(L,λ,h),则首先根据步骤(4)中所述迭代获得直角坐标(x,y,z),进而观测位置误差δx,δy,δz。
通过以上步骤可以实现大飞机INS/GNSS全球组合导航方法,实现全球范围内的准确定位导航,且不会出现导航滤波器震荡问题。此外,高纬度地区位置坐标使用空间直角坐标的方式能够实现平滑输出。
与现有技术相比,本发明的优点在于:
(1)本发明解决了大飞机全球飞行过程中,由于导航坐标系转换带来的组合导航滤波器震荡问题,有效提高导航精度。此外,高纬度地区位置坐标使用空间直角坐标的方式能够实现平滑输出。
(2)本发明无需改变现有机载惯性/卫星组合导航***的算法设计结构,便于现有导航***的升级,能够更经济的实现,工程意义重大。
(3)本发明对于其它惯性基组合导航***全球导航方法的设计具有很大的启发意义。
附图说明
图1为本发明方法的流程示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明作进一步详细说明。
如图1所示,一种大飞机INS/GNSS组合导航方法,包括以下步骤:
一种大飞机INS/GNSS全球组合导航方法,包括以下步骤:
(1)确定大飞机高纬度飞行区域的导航坐标系及位置表示方式,包括如下步骤:
(1.1)确定大飞机高纬度地区飞行时的导航坐标系,高纬度地区导航坐标系确定为格网坐标系,其中,格网坐标系的定义为:格网平面平行于格林尼治子午面,其与大飞机位置点处切平面的交线为格网北向,地理北向与格网北向的夹角为格网角,以顺时针为正;格网天向与当地地理坐标系天向相同,其与格网东向、北向一起构成右手直角坐标系;将格网角σ表示为
其中,表示L当地纬度,λ表示当地经度;
(1.2)将大飞机在地球坐标系e下的位置p表示为直角坐标(x,y,z);
(2)确定大飞机在格网坐标系下的更新方程,包括姿态更新方程、速度更新方程、位置更新方程,具体实施如下:
(2.1)确定格网坐标系下的姿态更新方程为:
(2.2)确定格网坐标系下的速度vG的更新方程为:
其中,
式中,fb表示载体坐标系下表示的比力,gG表示格网坐标系下表示的重力矢量,表示地球坐标系相对于惯性坐标系的旋转角速度在格网坐标系下的投影,表示格网坐标系相对于地球坐标系的旋转角速度在格网坐标系下的投影,表示地球坐标系相对于惯性坐标系的旋转角速度在地球坐标系下的投影,ωie表示地球旋转角速度,Rx为格网东向的曲率半径,Ry为格网北向的曲率半径,τf为扭曲半径,表示格网东向速度,表示格网北向速度;
(2.3)确定格网坐标系下的位置更新方程为:
(3)确定大飞机在格网坐标系下的姿态误差方程、速度误差方程、位置误差方程,具体实施如下:
确定姿态误差φG的方程如下:
确定速度误差δvG的方程如下:
确定位置误差δp的方程如下:
(4)确定大飞机导航参数在地理坐标系与格网坐标系之间的转换关系并进行转换,导航参数的转换包括姿态转换、速度转换、位置转换;
其中,大飞机姿态参数在地理坐标系、格网坐标系之间的转换关系为:
大飞机速度参数在地理坐标系、格网坐标系之间的转换关系为:
式中,vn表示地理坐标系下表示的速度;
大飞机位置参数在格网坐标系、地理坐标系之间的转换关系为:
式中,RN为卯酉圈曲率半径,f为椭圆扁率,h为大飞机相对于水平面的高度;
离开高纬度地区时,纬度、经度、高度通过迭代近似逼近求解,包括初始化与迭代计算两个步骤,首先初始化如下:
h=0
RN=Re
式中,Re表示地球长半轴;
初始化结束后,按照如下过程迭代计算:
L=arctan([z+e2RNsinL]/R)
式中,e表示椭圆偏心率;
迭代计算3~4次即满足精度要求;
(5)完成INS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中INS/GNSS组合导航滤波器采用闭环反馈校正方式,具体实施如下:
(5.1)分别确定地理坐标系与格网坐标系下的***误差状态为:
地理坐标系下的***误差状态xn(t)为
格网坐标系下的***误差状态xG(t)为
其中,分别表示地理坐标系下表示的东向、北向、垂向姿态误差,分别表示格网坐标系下表示的东向、北向、垂向姿态误差,分别表示地理坐标系下表示的东向、北向、垂向速度误差,分别表示格网坐标系下表示的东向、北向、垂向速度误差,δL,δλ分别表示纬度、经度误差,δx,δy,δz分别表示直角坐标x,y,z的误差,分别表示x、y、z轴向陀螺常值零偏,分别表示x、y、z轴向加表常值零偏,分别表示INS相对于GNSS天线在x,y,z三个方向的安装杆臂;
(5.2)分别确定姿态误差、速度误差、位置误差在地理坐标系与格网坐标系下间的转换关系为:
首先确定地理坐标系下姿态误差φn与格网坐标系下姿态误差φG之间的转换关系
式中,
其次确定地理坐标系下速度误差δvn与格网坐标系下速度误差δvG之间的转换关系
进而确定纬度误差δL、经度误差δλ、高度误差δh与直角坐标位置误差(δx,δy,δz)的转换关系
(5.3)根据步骤(5.2),确定地理坐标系下***误差状态协方差矩阵Pn(t)与格网坐标系下***误差状态协方差矩阵PG(t)的转换关系:
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,δx,δy,δz与δL、δλ、δh之间的转换关系,并考虑陀螺常值零偏加表常值零偏安装杆臂误差在地理坐标系与格网坐标系下的不变性进行确定;
(5.4)当大飞机在中纬度、高纬度地区连续飞行时,闭环反馈INS/GNSS组合导航滤波器完成在地理坐标系与格网坐标系之间的协方差矩阵转换,转换方式按照步骤(5.3)所述,鉴于***误差状态在每次闭环反馈校正后为0,其不需要转换。
进一步的,所述步骤(4)中导航参数在地理坐标系与格网坐标系之间转换时基于转换时刻的纬度阈值判断,且地理坐标系转换到格网坐标系、格网坐标系转换到地理坐标系两种情况下的阈值设定不同。
进一步的,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS速度信息,即在中低纬度的观测量为地理坐标系下速度误差δvn,在高纬度的观测量为格网坐标系下速度误差δvG。
进一步的,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS位置信息,即在中低纬度以δL,δλ,δh为观测量,在高纬度以δx,δy,δz为观测量。
进一步的,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS速度信息、位置信息,即在中低纬度的观测量为地理坐标系下速度误差δvn及位置误差δL,δλ,δh,在高纬度的观测量为格网坐标系下速度误差δvG及位置误差δx,δy,δz。
特别的,在高纬度地区,若GNSS输出的直角坐标(x,y,z),则直接观测位置误差δx,δy,δz;若GNSS输出球面坐标(L,λ,h),则首先根据步骤(4)中所述迭代获得直角坐标(x,y,z),进而观测位置误差δx,δy,δz。
以上所述仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (6)
1.一种大飞机INS/GNSS全球组合导航方法,其特征在于,包括以下步骤:
(1)确定大飞机高纬度飞行区域的导航坐标系及位置表示方式,包括如下步骤:
(1.1)确定大飞机高纬度地区飞行时的导航坐标系,高纬度地区导航坐标系确定为格网坐标系,其中,格网坐标系的定义为:格网平面平行于格林尼治子午面,其与大飞机位置点处切平面的交线为格网北向,地理北向与格网北向的夹角为格网角,以顺时针为正;格网天向与当地地理坐标系天向相同,其与格网东向、北向一起构成右手直角坐标系;将格网角σ表示为
其中,表示L当地纬度,λ表示当地经度;
(1.2)将大飞机在地球坐标系e下的位置p表示为直角坐标(x,y,z);
(2)确定大飞机在格网坐标系下的更新方程,包括姿态更新方程、速度更新方程、位置更新方程,具体实施如下:
(2.1)确定格网坐标系下的姿态更新方程为:
(2.2)确定格网坐标系下的速度vG的更新方程为:
其中,
式中,fb表示载体坐标系下表示的比力,gG表示格网坐标系下表示的重力矢量,表示地球坐标系相对于惯性坐标系的旋转角速度在格网坐标系下的投影,表示格网坐标系相对于地球坐标系的旋转角速度在格网坐标系下的投影,表示地球坐标系相对于惯性坐标系的旋转角速度在地球坐标系下的投影,ωie表示地球旋转角速度,Rx为格网东向的曲率半径,Ry为格网北向的曲率半径,τf为扭曲半径,表示格网东向速度,表示格网北向速度;
(2.3)确定格网坐标系下的位置更新方程为:
(3)确定大飞机在格网坐标系下的姿态误差方程、速度误差方程、位置误差方程,具体实施如下:
确定姿态误差φG的方程如下:
确定速度误差δvG的方程如下:
确定位置误差δp的方程如下:
(4)确定大飞机导航参数在地理坐标系与格网坐标系之间的转换关系并进行转换,导航参数的转换包括姿态转换、速度转换、位置转换;
其中,大飞机姿态参数在地理坐标系、格网坐标系之间的转换关系为:
大飞机速度参数在地理坐标系、格网坐标系之间的转换关系为:
式中,vn表示地理坐标系下表示的速度;
大飞机位置参数在格网坐标系、地理坐标系之间的转换关系为:
式中,RN为卯酉圈曲率半径,f为椭圆扁率,h为大飞机相对于水平面的高度;
离开高纬度地区时,纬度、经度、高度通过迭代近似逼近求解,包括初始化与迭代计算两个步骤,首先初始化如下:
h=0
RN=Re
式中,Re表示地球长半轴;
初始化结束后,按照如下过程迭代计算:
L=arctan([z+e2RNsin L]/R)
式中,e表示椭圆偏心率;
迭代计算3~4次即满足精度要求;
(5)完成INS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中INS/GNSS组合导航滤波器采用闭环反馈校正方式,具体实施如下:
(5.1)分别确定地理坐标系与格网坐标系下的***误差状态为:
地理坐标系下的***误差状态xn(t)为
格网坐标系下的***误差状态xG(t)为
其中,分别表示地理坐标系下表示的东向、北向、垂向姿态误差,分别表示格网坐标系下表示的东向、北向、垂向姿态误差,分别表示地理坐标系下表示的东向、北向、垂向速度误差,分别表示格网坐标系下表示的东向、北向、垂向速度误差,δL,δλ分别表示纬度、经度误差,δx,δy,δz分别表示直角坐标x,y,z的误差,分别表示x、y、z轴向陀螺常值零偏,分别表示x、y、z轴向加表常值零偏,分别表示INS相对于GNSS天线在x,y,z三个方向的安装杆臂;
(5.2)分别确定姿态误差、速度误差、位置误差在地理坐标系与格网坐标系下间的转换关系为:
首先确定地理坐标系下姿态误差φn与格网坐标系下姿态误差φG之间的转换关系
式中,
其次确定地理坐标系下速度误差δvn与格网坐标系下速度误差δvG之间的转换关系
进而确定纬度误差δL、经度误差δλ、高度误差δh与直角坐标位置误差(δx,δy,δz)的转换关系
(5.3)根据步骤(5.2),确定地理坐标系下***误差状态协方差矩阵Pn(t)与格网坐标系下***误差状态协方差矩阵PG(t)的转换关系:
Pn(t)=Φ-1PG(t)Φ-T
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,δx,δy,δz与δL、δλ、δh之间的转换关系,并考虑陀螺常值零偏加表常值零偏安装杆臂误差在地理坐标系与格网坐标系下的不变性进行确定;
(5.4)当大飞机在中纬度、高纬度地区连续飞行时,闭环反馈INS/GNSS组合导航滤波器完成在地理坐标系与格网坐标系之间的协方差矩阵转换,转换方式按照步骤(5.3)所述,鉴于***误差状态在每次闭环反馈校正后为0,其不需要转换。
2.如权利要求1所述的一种大飞机INS/GNSS全球组合导航方法,其特征在于,所述步骤(4)中导航参数在地理坐标系与格网坐标系之间转换时基于转换时刻的纬度阈值判断,且地理坐标系转换到格网坐标系、格网坐标系转换到地理坐标系两种情况下的阈值设定不同。
3.如权利要求1所述的一种大飞机INS/GNSS全球组合导航方法,其特征在于,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS速度信息,即在中低纬度的观测量为地理坐标系下速度误差δvn,在高纬度的观测量为格网坐标系下速度误差δvG。
4.如权利要求1所述的一种大飞机INS/GNSS全球组合导航方法,其特征在于,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS位置信息,即在中低纬度以δL,δλ,δh为观测量,在高纬度以δx,δy,δz为观测量。
5.如权利要求1所述的一种大飞机INS/GNSS全球组合导航方法,其特征在于,所述步骤(5)中INS/GNSS组合导航滤波器的观测量为GNSS速度信息、位置信息,即在中低纬度的观测量为地理坐标系下速度误差δvn及位置误差δL,δλ,δh,在高纬度的观测量为格网坐标系下速度误差δvG及位置误差δx,δy,δz。
6.如权利要求4或5所述的一种大飞机INS/GNSS全球组合导航方法,其特征在于,在高纬度地区,若GNSS输出的直角坐标(x,y,z),则直接观测位置误差δx,δy,δz;若GNSS输出球面坐标(L,λ,h),则首先根据步骤(4)中所述迭代获得直角坐标(x,y,z),进而观测位置误差δx,δy,δz。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110502705.3A CN113155125B (zh) | 2021-05-09 | 2021-05-09 | 一种大飞机ins/gnss全球组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110502705.3A CN113155125B (zh) | 2021-05-09 | 2021-05-09 | 一种大飞机ins/gnss全球组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113155125A true CN113155125A (zh) | 2021-07-23 |
CN113155125B CN113155125B (zh) | 2022-06-14 |
Family
ID=76874142
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110502705.3A Active CN113155125B (zh) | 2021-05-09 | 2021-05-09 | 一种大飞机ins/gnss全球组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113155125B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114563015A (zh) * | 2021-12-22 | 2022-05-31 | 四川大学 | 基于rf航段的实际导航性能实时计算方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140074397A1 (en) * | 2012-09-07 | 2014-03-13 | Honeywell International Inc. | Method and system for providing integrity for hybrid attitude and true heading |
CN104215242A (zh) * | 2014-09-30 | 2014-12-17 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
CN107543545A (zh) * | 2017-10-30 | 2018-01-05 | 中国人民解放军国防科技大学 | 极区双航海惯性导航***定位信息融合方法 |
CN107907898A (zh) * | 2017-11-07 | 2018-04-13 | 西安建筑科技大学 | 基于格网框架的极区sins/gps组合导航算法 |
CN112539745A (zh) * | 2020-08-13 | 2021-03-23 | 哈尔滨工业大学 | 基于外传感器辅助的双坐标系转换导航算法 |
-
2021
- 2021-05-09 CN CN202110502705.3A patent/CN113155125B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140074397A1 (en) * | 2012-09-07 | 2014-03-13 | Honeywell International Inc. | Method and system for providing integrity for hybrid attitude and true heading |
CN104215242A (zh) * | 2014-09-30 | 2014-12-17 | 东南大学 | 一种基于横向游移坐标系的极区惯性导航方法 |
CN107543545A (zh) * | 2017-10-30 | 2018-01-05 | 中国人民解放军国防科技大学 | 极区双航海惯性导航***定位信息融合方法 |
CN107907898A (zh) * | 2017-11-07 | 2018-04-13 | 西安建筑科技大学 | 基于格网框架的极区sins/gps组合导航算法 |
CN112539745A (zh) * | 2020-08-13 | 2021-03-23 | 哈尔滨工业大学 | 基于外传感器辅助的双坐标系转换导航算法 |
Non-Patent Citations (3)
Title |
---|
SUN JIN 等: "Transfer alignment method for SINS based on reverse navigation solution and data fusion", 《JOURNAL OF CHINESE INERTIAL TECHNOLOGY》 * |
王林: "航海多惯导协同定位与误差参数估计", 《中国博士学位论文全文数据库工程科技Ⅱ辑》 * |
王林等: "基于格网系的双航海惯导定位信息融合", 《中国惯性技术学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114563015A (zh) * | 2021-12-22 | 2022-05-31 | 四川大学 | 基于rf航段的实际导航性能实时计算方法 |
CN114563015B (zh) * | 2021-12-22 | 2023-10-10 | 四川大学 | 基于rf航段的实际导航性能实时计算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113155125B (zh) | 2022-06-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110262553B (zh) | 基于位置信息的固定翼无人机编队飞行方法 | |
CN110274588B (zh) | 基于无人机集群信息的双层嵌套因子图多源融合导航方法 | |
CN115200574B (zh) | 一种地球椭球模型下的极区横向组合导航方法 | |
CN108151737B (zh) | 一种动态互观测关系条件下的无人机蜂群协同导航方法 | |
CN104165640A (zh) | 基于星敏感器的近空间弹载捷联惯导***传递对准方法 | |
CN113108783B (zh) | 一种无人潜航器惯性/多普勒组合导航方法 | |
CN108225325B (zh) | 基于虚拟球模型的极地横向导航方法 | |
CN109506660B (zh) | 一种用于仿生导航的姿态最优化解算方法 | |
CN113295162B (zh) | 基于无人机状态信息的广义因子图融合导航方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN110046436B (zh) | 航天器自主测控覆盖分析方法 | |
CN111156986B (zh) | 一种基于抗差自适应ukf的光谱红移自主组合导航方法 | |
CN108021138B (zh) | 一种地磁场模型简化设计方法 | |
CN110457813A (zh) | 基于横向地理坐标系的虚拟极区方法 | |
CN106979781A (zh) | 基于分布式惯性网络的高精度传递对准方法 | |
CN105115508A (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN112713922A (zh) | 一种多波束通讯卫星的可见性快速预报算法 | |
CN113108787B (zh) | 一种长航时惯导/卫星全球组合导航方法 | |
CN107907898A (zh) | 基于格网框架的极区sins/gps组合导航算法 | |
CN113155125B (zh) | 一种大飞机ins/gnss全球组合导航方法 | |
CN114018242A (zh) | 一种基于偏振/太阳/惯性信息智能匹配的自主定姿方法 | |
CN106643726B (zh) | 一种统一惯性导航解算方法 | |
CN111207773A (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN111060140B (zh) | 一种地球椭球模型下的极区惯性导航误差获得方法 | |
CN113108789B (zh) | 一种大飞机ins/gnss组合导航方法 |
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 |