CN113108786A - 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 - Google Patents
考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 Download PDFInfo
- Publication number
- CN113108786A CN113108786A CN202110502713.8A CN202110502713A CN113108786A CN 113108786 A CN113108786 A CN 113108786A CN 202110502713 A CN202110502713 A CN 202110502713A CN 113108786 A CN113108786 A CN 113108786A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- error
- grid
- navigation
- representing
- 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
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)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明属于导航技术领域,公开了考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法,适用于大飞机全球飞行导航。本发明以地理坐标系、格网坐标系下的组合导航滤波器为基础,建立了系统误差状态及其协方差矩阵在两个导航坐标系之间的转换关系,能够实现滤波状态的稳定平滑过渡,避免坐标系转换过程中的滤波状态跳变问题。此外,设计的滤波器采用了开环结构,能够保证RINS、GNSS系统导航信息的独立性,满足了长航时飞机的全球安全可靠飞行。本发明解决了长航时飞机全球飞行过程中,由于导航坐标系转换带来的组合导航滤波器震荡问题,有效提高导航精度。本发明设计滤波器能够保证RINS、GNSS导航信息的独立性,避免GNSS信息受干扰情况下影响RINS工作的独立性。
Description
技术领域
本发明属于导航技术领域,涉及惯性/卫星组合导航方法,特别涉及考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法,适用于长航时飞机的全球飞行导航。
背景技术
近年来,飞机制造业得到了迅猛发展,特别是长航时飞机技术日趋进步,其在军民领域都得到了越来越多的应用,在民用领域,典型代表是大型客运飞机,在军用领域,典型代表是大型运输机、轰炸机。相较于一般飞机,长航时飞机具有以下几个典型特点:1.对飞行时长要求很高,要具备长时间不间断飞行能力;2.对飞行可靠性要求比较高,要具备安全、可靠飞行能力;3.近年来又对全球全纬度飞行提出了新的要求,要具备全球导航能力。
导航系统是长航时飞机十分重要的信息系统之一,其为长航时飞机提供准确、实时的导航信息以保障飞行过程。鉴于长航时飞机对飞行可靠性、全球导航能力有更高的要求,在设计长航时飞机导航系统时需要着重考虑这两方面。旋转调制惯导(RotationalInertial Navigation System)能够抵消惯性器件的确定性误差,进而提高导航精度,相较于一般的纯捷联惯导,其导航精度可以提高一个数量级;卫星导航系统(GlobalNavigaiton Satellite System)具有长期定位精度高、误差不累积的特点,但其存在易受干扰、不具有自主性的缺点;旋转调制惯导与卫星导航系统结合起来构成RINS/GNSS组合导航系统是一种十分理想的方案,但必须针对长航时飞机全球、可靠飞行的应用特点,对RINS/GNSS组合导航系统进行特别设计。
长航时飞机全球飞行需要解决目前现有研究忽视的飞行连续性问题,现有研究主要关注的仅仅是在高纬度地区的区域导航能力,对长航时飞机在不同纬度、不同区域之间的连续飞行过程缺少足够认识。目前,在中低纬度地区,RINS/GNSS组合导航算法一般在当地水平地理坐标系下设计,在高纬度地区一般在格网坐标系下设计。当长航时飞机在两个地区之间连续飞行时,组合导航算法需要在不同坐标系之间转换,以实现组合导航滤波器的一致估计,避免滤波状态震荡,而这正是现有技术忽视的地方。另一方面,为了保证导航信息的可靠性,在设计组合导航算法时,要保证RINS与GNSS之间信息的独立性,传统的闭环反馈滤波方法难以适用。
本发明针对目前存在的问题,提出一种考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法,以地理坐标系、格网坐标系下的组合导航滤波器为基础,建立了系统误差状态及其协方差矩阵在两个导航坐标系之间的转换关系,能够实现滤波状态的稳定平滑过渡,避免坐标系转换过程中的滤波状态跳变问题。此外,设计的滤波器采用了开环结构,能够保证RINS、GNSS系统导航信息的独立性,满足了长航时飞机的全球安全可靠飞行。
发明内容
本发明要解决的技术问题就在于:解决长航时飞机全球飞行过程中导航坐标系转换导致的滤波不稳定问题,实现系统误差状态的平滑过渡,提高导航精度,并且同时保证旋转调制惯导系统与卫星导航系统的独立性,为长航时飞机安全可靠飞行提供更加准确的导航信息。
为解决上述技术问题,本发明提出的解决方案为:
考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法,包括以下步骤:
(1)确定长航时飞机高纬度飞行区域的导航坐标系及位置表示方式,包括如下步骤:
(1.1)确定长航时飞机高纬度地区飞行时的导航坐标系,高纬度地区导航坐标系确定为格网坐标系,其中,格网坐标系的定义为:格网平面平行于格林尼治子午面,其与长航时飞机位置点处切平面的交线为格网北向,地理北向与格网北向的夹角为格网角,以顺时针为正;格网天向与当地地理坐标系天向相同,其与格网东向、北向一起构成右手直角坐标系;将格网角σ表示为
其中,表示L当地纬度,λ表示当地经度;
(2)确定长航时飞机在格网坐标系下的更新方程,包括姿态更新方程、速度更新方程、位置更新方程,具体实施如下:
(2.1)确定格网坐标系下的姿态更新方程为:
(2.2)确定格网坐标系下的速度vG的更新方程为:
其中,
式中,fb表示载体坐标系下表示的比力,gG表示格网坐标系下表示的重力矢量,表示地球坐标系相对于惯性坐标系的旋转角速度在格网坐标系下的投影,表示格网坐标系相对于地球坐标系的旋转角速度在格网坐标系下的投影,表示地球坐标系相对于惯性坐标系的旋转角速度在地球坐标系下的投影,ωie表示地球旋转角速度,Rx为格网东向的曲率半径,Ry为格网北向的曲率半径,τf为扭曲半径,表示格网东向速度,表示格网北向速度;
(2.3)确定格网坐标系下的位置更新方程为:
(3)确定长航时飞机在格网坐标系下的姿态误差方程、速度误差方程、位置误差方程,具体实施如下:
确定姿态误差φG的方程如下:
确定速度误差δvG的方程如下:
确定位置误差方程,位置误差包括位置矩阵误差θG与高度误差δh,且位置矩阵误差方程采用位置误差角的微分方程表示:
高度误差方程为:
(4)确定长航时飞机导航参数在地理坐标系与格网坐标系之间的转换关系并进行转换,导航参数的转换包括姿态转换、速度转换、位置转换;
其中,长航时飞机姿态参数在地理坐标系、格网坐标系之间的转换关系为:
长航时飞机速度参数在地理坐标系、格网坐标系之间的转换关系为:
式中,vn表示地理坐标系下表示的速度;
长航时飞机位置参数在地理坐标系、格网坐标系之间的转换关系为:
高度h在两个坐标系下保持不变;
(5)完成RINS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中RINS/GNSS组合导航滤波器采用开环反馈校正方式,具体实施如下:
(5.1)分别确定地理坐标系与格网坐标系下的系统误差状态为:
地理坐标系下的系统误差状态xn(t)为
格网坐标系下的系统误差状态xG(t)为
其中,分别表示地理坐标系下表示的东向、北向、垂向姿态误差,分别表示格网坐标系下表示的东向、北向、垂向姿态误差,分别表示地理坐标系下表示的东向、北向、垂向速度误差,分别表示格网坐标系下表示的东向、北向、垂向速度误差,δL,δλ分别表示纬度、经度误差,分别表示位置误差角东向、北向误差,分别表示x、y、z轴向陀螺常值零偏,分别表示x、y、z轴向加表常值零偏,分别表示RINS相对于GNSS天线在x,y,z三个方向的安装杆臂;
(5.2)分别确定姿态误差、速度误差、位置误差在地理坐标系与格网坐标系下间的转换关系为:
首先确定地理坐标系下姿态误差φn与格网坐标系下姿态误差φG之间的转换关系
式中,
其次确定地理坐标系下速度误差δvn与格网坐标系下速度误差δvG之间的转换关系
确定格网坐标系下的系统误差状态xG(t)与地理坐标系下的系统误差状态xn(t)之间的转换关系如下:
xG(t)=Φxn(t),xn(t)=Φ-1xG(t)
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,与δ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输出的球面坐标(L,λ,h),首先确定sinσ、cosσ,再依据sinσ、cosσ的值确定最后确定误差角东向误差北向误差分别为0.5(Ξ32-Ξ23)、0.5(Ξ13-Ξ31),式中,
特别的,在高纬度地区,根据GNSS输出的直角坐标(x,y,z)首先确定sinL、sinλ、cosL、cosλ,进而确定sinσ、cosσ,再依据sinσ、cosσ的值确定最后确定误差角东向误差北向误差分别为0.5(Ξ32-Ξ23)、0.5(Ξ13-Ξ31),式中, 为的解算值。
通过以上步骤可以实现长航时飞机RINS/GNSS全球组合导航方法,实现全球范围内的准确定位导航,不会出现导航滤波器震荡问题,并且能够保证RINS、GNSS导航信息的独立性。
与现有技术相比,本发明的优点在于:
(1)本发明解决了长航时飞机全球飞行过程中,由于导航坐标系转换带来的组合导航滤波器震荡问题,有效提高导航精度。
(2)本发明设计滤波器能够保证RINS、GNSS导航信息的独立性,避免GNSS信息受干扰情况下影响RINS工作的独立性。
(3)本发明无需改变现有长航时飞机旋转惯导/卫星组合导航系统的算法设计结构,便于现有导航系统的升级,能够更经济的实现,工程意义重大。
附图说明
图1为本发明方法的流程示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明作进一步详细说明。
如图1所示,考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法,包括以下步骤:
(1)确定长航时飞机高纬度飞行区域的导航坐标系及位置表示方式,包括如下步骤:
(1.1)确定长航时飞机高纬度地区飞行时的导航坐标系,高纬度地区导航坐标系确定为格网坐标系,其中,格网坐标系的定义为:格网平面平行于格林尼治子午面,其与长航时飞机位置点处切平面的交线为格网北向,地理北向与格网北向的夹角为格网角,以顺时针为正;格网天向与当地地理坐标系天向相同,其与格网东向、北向一起构成右手直角坐标系;将格网角σ表示为
其中,表示L当地纬度,λ表示当地经度;
(2)确定长航时飞机在格网坐标系下的更新方程,包括姿态更新方程、速度更新方程、位置更新方程,具体实施如下:
(2.1)确定格网坐标系下的姿态更新方程为:
(2.2)确定格网坐标系下的速度vG的更新方程为:
其中,
式中,fb表示载体坐标系下表示的比力,gG表示格网坐标系下表示的重力矢量,表示地球坐标系相对于惯性坐标系的旋转角速度在格网坐标系下的投影,表示格网坐标系相对于地球坐标系的旋转角速度在格网坐标系下的投影,表示地球坐标系相对于惯性坐标系的旋转角速度在地球坐标系下的投影,ωie表示地球旋转角速度,Rx为格网东向的曲率半径,Ry为格网北向的曲率半径,τf为扭曲半径,表示格网东向速度,表示格网北向速度;
(2.3)确定格网坐标系下的位置更新方程为:
(3)确定长航时飞机在格网坐标系下的姿态误差方程、速度误差方程、位置误差方程,具体实施如下:
确定姿态误差φG的方程如下:
确定速度误差δvG的方程如下:
确定位置误差方程,位置误差包括位置矩阵误差θG与高度误差δh,且位置矩阵误差方程采用位置误差角的微分方程表示:
高度误差方程为:
(4)确定长航时飞机导航参数在地理坐标系与格网坐标系之间的转换关系并进行转换,导航参数的转换包括姿态转换、速度转换、位置转换;
其中,长航时飞机姿态参数在地理坐标系、格网坐标系之间的转换关系为:
长航时飞机速度参数在地理坐标系、格网坐标系之间的转换关系为:
式中,vn表示地理坐标系下表示的速度;
长航时飞机位置参数在地理坐标系、格网坐标系之间的转换关系为:
高度h在两个坐标系下保持不变;
(5)完成RINS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中RINS/GNSS组合导航滤波器采用开环反馈校正方式,具体实施如下:
(5.1)分别确定地理坐标系与格网坐标系下的系统误差状态为:
地理坐标系下的系统误差状态xn(t)为
格网坐标系下的系统误差状态xG(t)为
其中,分别表示地理坐标系下表示的东向、北向、垂向姿态误差,分别表示格网坐标系下表示的东向、北向、垂向姿态误差,分别表示地理坐标系下表示的东向、北向、垂向速度误差,分别表示格网坐标系下表示的东向、北向、垂向速度误差,δL,δλ分别表示纬度、经度误差,分别表示位置误差角东向、北向误差,分别表示x、y、z轴向陀螺常值零偏,分别表示x、y、z轴向加表常值零偏,分别表示RINS相对于GNSS天线在x,y,z三个方向的安装杆臂;
(5.2)分别确定姿态误差、速度误差、位置误差在地理坐标系与格网坐标系下间的转换关系为:
首先确定地理坐标系下姿态误差φn与格网坐标系下姿态误差φG之间的转换关系
式中,
其次确定地理坐标系下速度误差δvn与格网坐标系下速度误差δvG之间的转换关系
确定格网坐标系下的系统误差状态xG(t)与地理坐标系下的系统误差状态xn(t)之间的转换关系如下:
xG(t)=Φxn(t),xn(t)=Φ-1xG(t)
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,与δ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输出的球面坐标(L,λ,h),首先确定sinσ、cosσ,再依据sinσ、cosσ的值确定最后确定误差角东向误差北向误差分别为0.5(Ξ32-Ξ23)、0.5(Ξ13-Ξ31),式中,
特别的,在高纬度地区,根据GNSS输出的直角坐标(x,y,z)首先确定sinL、sinλ、cosL、cosλ,进而确定sinσ、cosσ,再依据sinσ、cosσ的值确定最后确定误差角东向误差北向误差分别为0.5(Ξ32-Ξ23)、0.5(Ξ13-Ξ31),式中, 为的解算值。
以上所述仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (8)
1.考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法,其特征在于,包括以下步骤:
(1)确定长航时飞机高纬度飞行区域的导航坐标系及位置表示方式,包括如下步骤:
(1.1)确定长航时飞机高纬度地区飞行时的导航坐标系,高纬度地区导航坐标系确定为格网坐标系,其中,格网坐标系的定义为:格网平面平行于格林尼治子午面,其与长航时飞机位置点处切平面的交线为格网北向,地理北向与格网北向的夹角为格网角,以顺时针为正;格网天向与当地地理坐标系天向相同,其与格网东向、北向一起构成右手直角坐标系;将格网角σ表示为
其中,表示L当地纬度,λ表示当地经度;
(2)确定长航时飞机在格网坐标系下的更新方程,包括姿态更新方程、速度更新方程、位置更新方程,具体实施如下:
(2.1)确定格网坐标系下的姿态更新方程为:
(2.2)确定格网坐标系下的速度vG的更新方程为:
其中,
式中,fb表示载体坐标系下表示的比力,gG表示格网坐标系下表示的重力矢量,表示地球坐标系相对于惯性坐标系的旋转角速度在格网坐标系下的投影,表示格网坐标系相对于地球坐标系的旋转角速度在格网坐标系下的投影,表示地球坐标系相对于惯性坐标系的旋转角速度在地球坐标系下的投影,ωie表示地球旋转角速度,Rx为格网东向的曲率半径,Ry为格网北向的曲率半径,τf为扭曲半径,表示格网东向速度,表示格网北向速度;
(2.3)确定格网坐标系下的位置更新方程为:
(3)确定长航时飞机在格网坐标系下的姿态误差方程、速度误差方程、位置误差方程,具体实施如下:
确定姿态误差φG的方程如下:
确定速度误差δvG的方程如下:
确定位置误差方程,位置误差包括位置矩阵误差θG与高度误差δh,且位置矩阵误差方程采用位置误差角的微分方程表示:
高度误差方程为:
(4)确定长航时飞机导航参数在地理坐标系与格网坐标系之间的转换关系并进行转换,导航参数的转换包括姿态转换、速度转换、位置转换;
其中,长航时飞机姿态参数在地理坐标系、格网坐标系之间的转换关系为:
长航时飞机速度参数在地理坐标系、格网坐标系之间的转换关系为:
式中,vn表示地理坐标系下表示的速度;
长航时飞机位置参数在地理坐标系、格网坐标系之间的转换关系为:
高度h在两个坐标系下保持不变;
(5)完成RINS/GNSS组合导航滤波器在地理坐标系与格网坐标系之间的转换,其中RINS/GNSS组合导航滤波器采用开环反馈校正方式,具体实施如下:
(5.1)分别确定地理坐标系与格网坐标系下的系统误差状态为:
地理坐标系下的系统误差状态xn(t)为
格网坐标系下的系统误差状态xG(t)为
其中,分别表示地理坐标系下表示的东向、北向、垂向姿态误差,分别表示格网坐标系下表示的东向、北向、垂向姿态误差,分别表示地理坐标系下表示的东向、北向、垂向速度误差,分别表示格网坐标系下表示的东向、北向、垂向速度误差,δL,δλ分别表示纬度、经度误差,分别表示位置误差角东向、北向误差,分别表示x、y、z轴向陀螺常值零偏,分别表示x、y、z轴向加表常值零偏,分别表示RINS相对于GNSS天线在x,y,z三个方向的安装杆臂;
(5.2)分别确定姿态误差、速度误差、位置误差在地理坐标系与格网坐标系下间的转换关系为:
首先确定地理坐标系下姿态误差φn与格网坐标系下姿态误差φG之间的转换关系
式中,
其次确定地理坐标系下速度误差δvn与格网坐标系下速度误差δvG之间的转换关系
确定格网坐标系下的系统误差状态xG(t)与地理坐标系下的系统误差状态xn(t)之间的转换关系如下:
xG(t)=Φxn(t),xn(t)=Φ-1xG(t)
其中,Φ为转换系数矩阵,并且根据φG与φn之间的转换关系,δvG与δvn之间的转换关系,与δ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为单轴旋转调制惯导、或双轴旋转调制惯导、或三轴旋转调制惯导。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110502713.8A CN113108786B (zh) | 2021-05-09 | 2021-05-09 | 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110502713.8A CN113108786B (zh) | 2021-05-09 | 2021-05-09 | 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113108786A true CN113108786A (zh) | 2021-07-13 |
CN113108786B CN113108786B (zh) | 2022-06-14 |
Family
ID=76721775
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110502713.8A Active CN113108786B (zh) | 2021-05-09 | 2021-05-09 | 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113108786B (zh) |
Citations (2)
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 |
CN107543545A (zh) * | 2017-10-30 | 2018-01-05 | 中国人民解放军国防科技大学 | 极区双航海惯性导航系统定位信息融合方法 |
-
2021
- 2021-05-09 CN CN202110502713.8A patent/CN113108786B/zh active Active
Patent Citations (2)
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 |
CN107543545A (zh) * | 2017-10-30 | 2018-01-05 | 中国人民解放军国防科技大学 | 极区双航海惯性导航系统定位信息融合方法 |
Non-Patent Citations (2)
Title |
---|
SUN JIN 等: "Transfer alignment method for SINS based on reverse navigation solution and data fusion", 《JOURNAL OF CHINESE INERTIAL TECHNOLOGY》 * |
王林: "航海多惯导协同定位与误差参数估计", 《中国博士学位论文全文数据库工程科技Ⅱ辑》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113108786B (zh) | 2022-06-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109813311B (zh) | 一种无人机编队协同导航方法 | |
CN103917850B (zh) | 一种惯性导航系统的运动对准方法 | |
CN102692225B (zh) | 一种用于低成本小型无人机的姿态航向参考系统 | |
CN103245360A (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN111207745B (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
CN108871326B (zh) | 一种单轴旋转调制惯性-天文深组合导航方法 | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
CN105258698A (zh) | 一种高动态自旋制导炮弹空中组合导航方法 | |
CN103063216B (zh) | 一种基于星像坐标建模的惯性与天文组合导航方法 | |
CN113108783B (zh) | 一种无人潜航器惯性/多普勒组合导航方法 | |
CN109269526B (zh) | 基于阻尼网络的旋转式格网惯导水平阻尼方法 | |
CN103837151A (zh) | 一种四旋翼飞行器的气动模型辅助导航方法 | |
CN105115508A (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN105180728A (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN110398242A (zh) | 一种高旋高过载条件飞行器的姿态角确定方法 | |
CN112179340A (zh) | 一种冗余配置惯性测量单元双轴旋转调制方法 | |
CN102788597A (zh) | 基于空间稳定的旋转捷联惯导系统误差抑制方法 | |
CN109489661A (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN113108787B (zh) | 一种长航时惯导/卫星全球组合导航方法 | |
CN113212804B (zh) | 一种绳系卫星姿态与角动量一体化控制方法 | |
CN113418499B (zh) | 一种旋转飞行器滚转角解算方法及系统 | |
CN113108788B (zh) | 一种长航时惯导/天文全球组合导航方法 | |
CN111060140B (zh) | 一种地球椭球模型下的极区惯性导航误差获得方法 | |
CN110488853B (zh) | 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 | |
CN113108786B (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 |