CN113108787B - 一种长航时惯导/卫星全球组合导航方法 - Google Patents
一种长航时惯导/卫星全球组合导航方法 Download PDFInfo
- Publication number
- CN113108787B CN113108787B CN202110502723.1A CN202110502723A CN113108787B CN 113108787 B CN113108787 B CN 113108787B CN 202110502723 A CN202110502723 A CN 202110502723A CN 113108787 B CN113108787 B CN 113108787B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- grid
- error
- navigation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000006243 chemical reaction Methods 0.000 claims abstract description 71
- 239000011159 matrix material Substances 0.000 claims abstract description 52
- 230000008569 process Effects 0.000 claims abstract description 10
- 238000012937 correction Methods 0.000 claims description 9
- 230000009897 systematic effect Effects 0.000 claims description 7
- 230000007704 transition Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims 1
- 230000007774 longterm Effects 0.000 abstract description 8
- 238000001914 filtration Methods 0.000 abstract description 7
- 230000009191 jumping Effects 0.000 abstract 1
- 230000010355 oscillation Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification 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
- 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
本发明属于导航技术领域,公开了一种长航时惯导/卫星全球组合导航方法,适用于大飞机全球飞行导航。本发明以地理坐标系、格网坐标系下的组合导航滤波器为基础,并基于空间直角坐标表示长航时飞机在高纬度地区的位置,以此建立了系统误差状态及其协方差矩阵在两个导航坐标系之间的转换关系,设计了滤波状态稳定的组合导航滤波器,解决了坐标系转换过程中的滤波状态跳变问题,并实现位置坐标在高纬度地区的平滑输出,满足了长航时飞机的全球飞行需求。此外,设计的滤波器采用了开环结构,能够保证RINS、GNSS系统导航信息的独立性,满足了长航时飞机的全球安全可靠飞行。
Description
技术领域
本发明属于导航技术领域,涉及惯性/卫星组合导航方法,特别涉及一种长航时惯导/卫星全球组合导航方法,适用于长航时飞机的全球飞行导航。
背景技术
近年来,飞机制造业得到了迅猛发展,特别是长航时飞机技术日趋进步,其在军民领域都得到了越来越多的应用,在民用领域,典型代表是大型客运飞机,在军用领域,典型代表是大型运输机、轰炸机。相较于一般飞机,长航时飞机具有以下几个典型特点:1.对飞行时长要求很高,要具备长时间不间断飞行能力;2.对飞行可靠性要求比较高,要具备安全、可靠飞行能力;3.近年来又对全球全纬度飞行提出了新的要求,要具备全球导航能力。
导航系统是长航时飞机十分重要的信息系统之一,其为长航时飞机提供准确、实时的导航信息以保障飞行过程。鉴于长航时飞机对飞行可靠性、全球导航能力有更高的要求,在设计长航时飞机导航系统时需要着重考虑这两方面。旋转调制惯导(RotationalInertial Navigation System)作为典型的长航时惯导系统,能够抵消惯性器件的确定性误差,进而提高导航精度,相较于一般的纯捷联惯导,其导航精度可以提高一个数量级;卫星导航系统(Global Navigaiton Satellite System)具有长期定位精度高、误差不累积的特点,但其存在易受干扰、不具有自主性的缺点;旋转调制惯导与卫星导航系统结合起来构成RINS/GNSS组合导航系统是一种十分理想的方案,但必须针对长航时飞机全球、可靠飞行的应用特点,对RINS/GNSS组合导航系统进行特别设计。
长航时飞机全球飞行需要解决目前现有研究忽视的飞行连续性问题,现有研究主要关注的仅仅是在高纬度地区的区域导航能力,对长航时飞机在不同纬度、不同区域之间的连续飞行过程缺少足够认识。目前,在中低纬度地区,RINS/GNSS组合导航算法一般在当地水平地理坐标系下设计,在高纬度地区一般在格网坐标系下设计。当长航时飞机在两个地区之间连续飞行时,组合导航算法需要在不同坐标系之间转换,以实现组合导航滤波器的一致估计,避免滤波状态震荡,而这正是现有技术忽视的地方。另一方面,为了保证导航信息的可靠性,在设计组合导航算法时,要保证RINS与GNSS之间信息的独立性,传统的闭环反馈滤波方法难以适用。
本发明针对目前存在的问题,提出一种长航时惯导/卫星全球组合导航方法,以地理坐标系、格网坐标系下的组合导航滤波器为基础,并基于空间直角坐标表示长航时飞机在高纬度地区的位置,以此建立了系统误差状态及其协方差矩阵在两个导航坐标系之间的转换关系,设计了滤波状态稳定的组合导航滤波器,解决了坐标系转换过程中的滤波状态跳变问题,并实现位置坐标在高纬度地区的平滑输出,满足了长航时飞机的全球飞行需求。此外,设计的滤波器采用了开环结构,能够保证RINS、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)完成RINS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中RINS/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)的转换关系
确定格网坐标系下的系统误差状态xG(t)与地理坐标系下的系统误差状态xn(t)之间的转换关系如下:
xG(t)=Φxn(t),xn(t)=Φ-1xG(t)
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,δx,δy,δz与δL、δλ、δh之间的转换关系,并考虑陀螺常值零偏加表常值零偏安装杆臂误差在地理坐标系与格网坐标系下的不变性进行确定;
(5.3)根据步骤(5.2),确定地理坐标系下系统误差状态协方差矩阵Pn(t)与格网坐标系下系统误差状态协方差矩阵PG(t)的转换关系:
Pn(t)=Φ-1PG(t)Φ-T
(5.4)当长航时飞机在中纬度、高纬度地区连续飞行时,开环反馈RINS/GNSS组合导航滤波器完成在地理坐标系与格网坐标系之间的系统误差状态、协方差矩阵转换,转换方式按照步骤(5.2)、步骤(5.3)所述,转换前后xn(t)、Pn(t),xG(t)、PG(t)按照如下方式进行更新:
式中,上标+、-分别表示更新后时刻、更新前时刻,下标k+1、k分别表示离散化k+1、k时刻,K、P、H、R、Q、F、γ分别表示增益矩阵、协方差矩阵、观测矩阵、观测噪声强度矩阵、系统噪声强度矩阵、状态转移矩阵、系统噪声矩阵,x、z分别表示系统状态向量、观测向量,I为单位矩阵;
(6)采用输出校正方式对RINS导航参数信息进行校正,在地理坐标系、格网坐标系下的导航参数校正方式分别如下:
进一步的,所述步骤(4)中导航参数在地理坐标系与格网坐标系之间转换时基于转换时刻的纬度阈值判断,且地理坐标系转换到格网坐标系、格网坐标系转换到地理坐标系两种情况下的阈值设定不同。
进一步的,所述步骤(5)中RINS/GNSS组合导航滤波器的观测量为GNSS速度信息,即在中低纬度的观测量为地理坐标系下速度误差δvn,在高纬度的观测量为格网坐标系下速度误差δvG。
进一步的,所述步骤(5)中RINS/GNSS组合导航滤波器的观测量为GNSS速度信息、位置信息,即在中低纬度的观测量为地理坐标系下速度误差δvn及位置误差δL,δλ,δh,在高纬度的观测量为格网坐标系下速度误差δvG及位置误差δh。
进一步的,所述步骤(5)中的RINS为单轴旋转调制惯导、或双轴旋转调制惯导、或三轴旋转调制惯导。
特别的,在高纬度地区,若GNSS输出的直角坐标(x,y,z),则直接观测位置误差δx,δy,δz;若GNSS输出球面坐标(L,λ,h),则首先根据步骤(4)中所述迭代获得直角坐标(x,y,z),进而观测位置误差δx,δy,δz。
通过以上步骤可以实现长航时飞机RINS/GNSS全球组合导航方法,实现全球范围内的准确定位导航,不会出现导航滤波器震荡问题,并且能够保证RINS、GNSS导航信息的独立性。
与现有技术相比,本发明的优点在于:
(1)本发明解决了长航时飞机全球飞行过程中,由于导航坐标系转换带来的组合导航滤波器震荡问题,有效提高导航精度。此外,高纬度地区位置坐标使用空间直角坐标的方式能够实现平滑输出。
(2)本发明设计滤波器能够保证RINS、GNSS导航信息的独立性,避免GNSS信息受干扰情况下影响RINS工作的独立性。
(3)本发明无需改变现有长航时飞机旋转惯导/卫星组合导航系统的算法设计结构,便于现有导航系统的升级,能够更经济的实现,工程意义重大。
附图说明
图1为本发明方法的流程示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明作进一步详细说明。
如图1所示,一种长航时惯导/卫星全球组合导航方法,包括以下步骤:
(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)完成RINS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中RINS/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)的转换关系
确定格网坐标系下的系统误差状态xG(t)与地理坐标系下的系统误差状态xn(t)之间的转换关系如下:
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,δx,δy,δz与δL、δλ、δh之间的转换关系,并考虑陀螺常值零偏加表常值零偏安装杆臂误差在地理坐标系与格网坐标系下的不变性进行确定;
(5.3)根据步骤(5.2),确定地理坐标系下系统误差状态协方差矩阵Pn(t)与格网坐标系下系统误差状态协方差矩阵PG(t)的转换关系:
(5.4)当长航时飞机在中纬度、高纬度地区连续飞行时,开环反馈RINS/GNSS组合导航滤波器完成在地理坐标系与格网坐标系之间的系统误差状态、协方差矩阵转换,转换方式按照步骤(5.2)、步骤(5.3)所述,转换前后xn(t)、Pn(t),xG(t)、PG(t)按照如下方式进行更新:
式中,上标+、-分别表示更新后时刻、更新前时刻,下标k+1、k分别表示离散化k+1、k时刻,K、P、H、R、Q、F、γ分别表示增益矩阵、协方差矩阵、观测矩阵、观测噪声强度矩阵、系统噪声强度矩阵、状态转移矩阵、系统噪声矩阵,x、z分别表示系统状态向量、观测向量,I为单位矩阵;
(6)采用输出校正方式对RINS导航参数信息进行校正,在地理坐标系、格网坐标系下的导航参数校正方式分别如下:
进一步的,所述步骤(4)中导航参数在地理坐标系与格网坐标系之间转换时基于转换时刻的纬度阈值判断,且地理坐标系转换到格网坐标系、格网坐标系转换到地理坐标系两种情况下的阈值设定不同。
进一步的,所述步骤(5)中RINS/GNSS组合导航滤波器的观测量为GNSS速度信息,即在中低纬度的观测量为地理坐标系下速度误差δvn,在高纬度的观测量为格网坐标系下速度误差δvG。
进一步的,所述步骤(5)中RINS/GNSS组合导航滤波器的观测量为GNSS速度信息、位置信息,即在中低纬度的观测量为地理坐标系下速度误差δvn及位置误差δL,δλ,δh,在高纬度的观测量为格网坐标系下速度误差δvG及位置误差δh。
进一步的,所述步骤(5)中的RINS为单轴旋转调制惯导、或双轴旋转调制惯导、或三轴旋转调制惯导。
特别的,在高纬度地区,若GNSS输出的直角坐标(x,y,z),则直接观测位置误差δx,δy,δz;若GNSS输出球面坐标(L,λ,h),则首先根据步骤(4)中所述迭代获得直角坐标(x,y,z),进而观测位置误差δx,δy,δz。
以上所述仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (7)
1.一种长航时惯导/卫星全球组合导航方法,其特征在于,包括以下步骤:
(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)完成RINS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中RINS/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)的转换关系
确定格网坐标系下的系统误差状态xG(t)与地理坐标系下的系统误差状态xn(t)之间的转换关系如下:
xG(t)=Φxn(t),xn(t)=Φ-1xG(t)
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,δx,δy,δz与δL、δλ、δh之间的转换关系,并考虑陀螺常值零偏加表常值零偏安装杆臂误差在地理坐标系与格网坐标系下的不变性进行确定;
(5.3)根据步骤(5.2),确定地理坐标系下系统误差状态协方差矩阵Pn(t)与格网坐标系下系统误差状态协方差矩阵PG(t)的转换关系:
Pn(t)=Φ-1PG(t)Φ-T
(5.4)当长航时飞机在中纬度、高纬度地区连续飞行时,开环反馈RINS/GNSS组合导航滤波器完成在地理坐标系与格网坐标系之间的系统误差状态、协方差矩阵转换,转换方式按照步骤(5.2)、步骤(5.3)所述,转换前后xn(t)、Pn(t),xG(t)、PG(t)按照如下方式进行更新:
式中,上标+、-分别表示更新后时刻、更新前时刻,下标k+1、k分别表示离散化k+1、k时刻,K、P、H、R、Q、F、Υ分别表示增益矩阵、协方差矩阵、观测矩阵、观测噪声强度矩阵、系统噪声强度矩阵、状态转移矩阵、系统噪声矩阵,x、z分别表示系统状态向量、观测向量,I为单位矩阵;
(6)采用输出校正方式对RINS导航参数信息进行校正,在地理坐标系、格网坐标系下的导航参数校正方式分别如下:
2.如权利要求1所述的一种长航时惯导/卫星全球组合导航方法,其特征在于,所述步骤(4)中导航参数在地理坐标系与格网坐标系之间转换时基于转换时刻的纬度阈值判断,且地理坐标系转换到格网坐标系、格网坐标系转换到地理坐标系两种情况下的阈值设定不同。
3.如权利要求1所述的一种长航时惯导/卫星全球组合导航方法,其特征在于,所述步骤(5)中RINS/GNSS组合导航滤波器的观测量为GNSS速度信息,即在中低纬度的观测量为地理坐标系下速度误差δvn,在高纬度的观测量为格网坐标系下速度误差δvG。
6.如权利要求1所述的一种长航时惯导/卫星全球组合导航方法,其特征在于,所述步骤(5)中的RINS为单轴旋转调制惯导、或双轴旋转调制惯导、或三轴旋转调制惯导。
7.如权利要求4或5所述的一种长航时惯导/卫星全球组合导航方法,其特征在于,在高纬度地区,若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 |
---|---|---|---|
CN202110502723.1A CN113108787B (zh) | 2021-05-09 | 2021-05-09 | 一种长航时惯导/卫星全球组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110502723.1A CN113108787B (zh) | 2021-05-09 | 2021-05-09 | 一种长航时惯导/卫星全球组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113108787A CN113108787A (zh) | 2021-07-13 |
CN113108787B true CN113108787B (zh) | 2022-06-14 |
Family
ID=76721776
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110502723.1A Active CN113108787B (zh) | 2021-05-09 | 2021-05-09 | 一种长航时惯导/卫星全球组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113108787B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113776527B (zh) * | 2021-09-13 | 2023-04-07 | 中国民用航空飞行学院 | 一种民航飞机全时空的组合导航系统和导航方法 |
CN114814921B (zh) * | 2022-03-10 | 2024-09-13 | 武汉理工大学 | 一种用于纯电动采贝机的综合导航方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9341718B2 (en) * | 2012-09-07 | 2016-05-17 | Honeywell International Inc. | Method and system for providing integrity for hybrid attitude and true heading |
CN107543545B (zh) * | 2017-10-30 | 2019-07-19 | 中国人民解放军国防科技大学 | 极区双航海惯性导航系统定位信息融合方法 |
-
2021
- 2021-05-09 CN CN202110502723.1A patent/CN113108787B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113108787A (zh) | 2021-07-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109813311B (zh) | 一种无人机编队协同导航方法 | |
CN113108787B (zh) | 一种长航时惯导/卫星全球组合导航方法 | |
CN115200574B (zh) | 一种地球椭球模型下的极区横向组合导航方法 | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
CN111207745B (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
CN109211269A (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN105258698A (zh) | 一种高动态自旋制导炮弹空中组合导航方法 | |
CN113108783B (zh) | 一种无人潜航器惯性/多普勒组合导航方法 | |
CN106840194B (zh) | 一种大方位失准角线性对准方法 | |
CN105928515A (zh) | 一种无人机导航系统 | |
CN105509769A (zh) | 一种运载火箭捷联惯导全自主对准方法 | |
CN107907898A (zh) | 基于格网框架的极区sins/gps组合导航算法 | |
CN109765530A (zh) | 一种运动平台雷达波束解耦方法 | |
CN110398242A (zh) | 一种高旋高过载条件飞行器的姿态角确定方法 | |
CN106643726B (zh) | 一种统一惯性导航解算方法 | |
CN113568442B (zh) | 一种对星控制系统及方法 | |
CN111207773A (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN105300407B (zh) | 一种用于单轴调制激光陀螺惯导系统的海上动态启动方法 | |
CN112729332B (zh) | 一种基于旋转调制的对准方法 | |
CN105928519A (zh) | 基于ins惯性导航与gps导航以及磁力计的导航算法 | |
CN113108788B (zh) | 一种长航时惯导/天文全球组合导航方法 | |
CN113155125B (zh) | 一种大飞机ins/gnss全球组合导航方法 | |
CN113108786B (zh) | 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 | |
CN112649001B (zh) | 一种小型无人机姿态与位置解算方法 | |
CN113108782B (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 |