CN105807303B - 基于gnss、ins和机载高度表的组合导航方法和设备 - Google Patents
基于gnss、ins和机载高度表的组合导航方法和设备 Download PDFInfo
- Publication number
- CN105807303B CN105807303B CN201610318680.0A CN201610318680A CN105807303B CN 105807303 B CN105807303 B CN 105807303B CN 201610318680 A CN201610318680 A CN 201610318680A CN 105807303 B CN105807303 B CN 105807303B
- Authority
- CN
- China
- Prior art keywords
- navigation
- gnss
- data
- ins
- satellite
- 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
Classifications
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种基于GNSS、INS和机载高度表的组合导航方法和设备,该方法包括:获取设置于飞行器上的GNSS系统、INS系统和机载高度表的数据;使用卡尔曼EKF滤波器对GNSS系统和INS系统的数据进行紧组合滤波,输出两个系统融合后的数据,并计算紧组合滤波残差,据以生成残差序列和残差预测;使用EKF滤波器将GNSS系统与INS系统融合后的数据与记载高度表的数据进行松组合滤波,输出三个系统融合后的数据,并计算松组合滤波残差,据以生成残差序列和残差预测;将紧组合滤波和松组合滤波生成的残差序列和残差预测构成EKF量测方程,执行导航误差状态估计,据以检测GNSS系统完好性,并对GNSS系统的故障进行隔离和修正。该方法能够有效提高机载导航设备的可用性和完好性。
Description
技术领域
本发明属于导航技术领域,尤其涉及一种组合导航方法和设备。
背景技术
随着技术及其应用的推广,全球卫星导航系统(GNSS)接收机已经成为机载电子装备中核心部件之一。GNSS接收机的性能一般通过精度、完好性、连续性和可用性等四个方面来进行评估。其中完好性主要是对接收机在应用的安全性方面的要求,因此在对安全要求较高的应用中,完好性是必须要解决的关键问题。
完好性一般定义为:完好性是一种概率,在特定时期、系统覆盖区域内的任一点,位置误差不超出告警门限(Alarm Limit),不给用户在告警时限(Time To Alarm)内发出告警信息的概率。
完好性问题对于航空来说是关系重大的,因为用户正以高速航行,如果不能及时的检测并排除故障卫星的话,飞机就很可能会偏离航路。随着机载系统对安全性能要求的日益提高,飞机上的导航系统也呈现多信息化、智能化、集成化的发展趋势。精确性与安全可靠性成为机载导航系统的重要特点。而精确定位定姿、故障检测隔离,已成为机载导航领域的重要学科技术之一,越来越受到人们的重视,近几年来得到了迅猛的发展。
GNSS虽然有传统陆基无线电导航系统无法比拟的全球覆盖、高精度等性能,但目前在飞行器导航领域并没有得到普遍应用。不考虑政治方面的影响,从技术而言,精度、完好性、连续性及可用性四个方面都没有可满足所有飞行阶段的需求。从完好性方面看,GNSS系统本身能进行一定程度的完好性监测,但告警时间太长,通常需几个小时。从连续性和可用性方面看,GPS虽然能保证所有地区能有4颗以上可视卫星,但卫星几何结构仍然存在较差情况,如果加上完好性要求,其可用性会更差。
GNSS接收机进行完好性监测采用RAIM算法,其基本原理是利用卫星测量的冗余观测信息对接收机导航定位结果进行超差判定,因此单纯卫星导航接收机完好性能受接收机跟踪锁定卫星数量、卫星几何分布及告警门限制约,具体如下:
(1)GNSS接收机完好性受限于可见卫星数
GNSS接收机通过基带处理单元可以输出接收机相对卫星的伪距,忽略噪声后,伪距是接收机三维位置和接收机钟差的函数,因此在进行三维导航时至少需要接收机跟踪4颗卫星才能解算出正确的接收机位置和钟差信息。假设只有一颗卫星出现故障,当观测到5颗卫星时,可以利用伪距间的冗余信息检测出对于当前飞行阶段,GNSS接收机存在不可接受的定位误差,但是由于没有其它信息,此时虽然可以给出超差告警,但不能锁定是哪颗卫星出现了故障;只有在同时观测到6颗以上卫星时才能确定出是哪颗卫星出现了故障。
(2)GNSS接收机完好性受限于卫星几何分布
GNSS接收机完好性能除和可见卫星数有关外,还和可见卫星的几何分布密切相关。通常在跟踪4颗以上卫星的条件下,当卫星与接收机之间构成的多面体体积最大时定位性能最佳,这时卫星星座的精度因子(DOP)最小。卫星几何分布越理想,接收机定位结果估计越准确,就越不容易超差,同时对故障卫星的监测能力也越高。因此GNSS卫星几何分布对接收机完好性有重要影响。
(3)GNSS接收机完好性受限于应用精度要求
GNSS接收机完好性是衡量接收机定位结果超差时的告警能力,因此完好性与告警门限密切相关,而告警门限的设定取决于实际的应用精度需求。
飞行器不同飞行阶段对GNSS导航的完好性能要求不同,随着GNSS导航在飞机精密进近阶段的应用研究,GNSS导航系统的精度和完好性能要求越来越高。
在精密进近阶段,尤其在3类精密进近阶段,对机载GNSS系统的完好性要求较高。考虑到卫星导航的体制局限性,单凭GNSS接收机算法优化很难满足要求。
发明内容
有鉴于此,本发明的一个目的是提供一种基于全球卫星导航系统(GNSS)、惯性导航系统(INS)和机载高度表的组合导航的方法和设备,由外部增强信息和辅助信息为GNSS导航系统提供更精确的测量信息和冗余测 量信息,从而提高机载导航设备的可用性和完好性。为了对披露的实施例的一些方面有一个基本的理解,下面给出了简单的概括。该概括部分不是泛泛评述,也不是要确定关键/重要组成元素或描绘这些实施例的保护范围。其唯一目的是用简单的形式呈现一些概念,以此作为后面的详细说明的序言。
本发明提供的一种基于GNSS、INS和机载高度表的组合导航方法包括:
获取设置于飞行器上的GNSS系统、INS系统和机载高度表的数据;
使用卡尔曼EKF滤波器对GNSS系统和INS系统的数据进行紧组合滤波,输出两个系统融合后的数据,并计算紧组合滤波残差,据以生成残差序列和残差预测;
使用EKF滤波器将GNSS系统与INS系统融合后的数据与记载高度表的数据进行松组合滤波,输出三个系统融合后的数据,并计算松组合滤波残差,据以生成残差序列和残差预测;
将紧组合滤波和松组合滤波生成的残差序列和残差预测构成EKF量测方程,执行导航误差状态估计,据以检测GNSS系统完好性,并对GNSS系统的故障进行隔离和修正。
较佳地,还包括:
使用导航误差状态估计产生伪距测量值的校正值,据以对INS系统的参数进行校正。
较佳地,所述EKF滤波器执行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
较佳地,所述EKF滤波器对GNSS系统和INS系统进行紧组合滤波 时若采用开环形式,还包括时间更新过程和量测更新过程,其中:
时间更新公式为:
量测更新公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
较佳地,所述EKF滤波器对GNSS系统和INS系统进行紧组合滤波时若采用闭环形式,还包括时间更新过程、量测更新过程和自适应反馈校正过程,其中:
时间更新公式为:
量测更新公式为:
自适应反馈校正公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
较佳地,采用GPS导航接收机、GLONASS导航接收机、GALILEO导航接收机和北斗导航接收机中的一种或者多种分别接收对应的卫星信号;将所述一种或者多种导航接收机接收到的卫星信号进行时空归一化处理后,进行数据融合处理后输出作为GNSS系统的输出信号。
较佳地,所述INS系统采用捷联惯性导航SINS系统。
本发明还提供了一种基于GNSS、INS和机载高度表的组合导航设备,包括:
设置于飞行器上的全球卫星导航系统GNSS、惯性导航系统INS、机载高度表;
紧组合滤波电路,采用卡尔曼EKF滤波器对GNSS系统和INS系统的数据进行紧组合滤波,输出两个系统融合后的数据,并计算紧组合滤波残差,据以生成残差序列和残差预测;
松组合滤波电路,采用卡尔曼EKF滤波器将GNSS系统与INS系统融合后的数据与记载高度表的数据进行松组合滤波,输出三个系统融合后的数据,并计算松组合滤波残差,据以生成残差序列和残差预测;
运算电路,用于将紧组合滤波电路和松组合滤波电路生成的残差序列和残差预测构成EKF量测方程,执行导航误差状态估计;
信号处理电路,用于根据导航误差状态估计检测GNSS系统完好性,并对GNSS系统的故障进行隔离和修正。
较佳地,还包括:反馈电路,用于使用导航误差状态估计产生伪距测量值的校正值,据以对INS系统的参数进行校正。
较佳地,所述GNSS系统包括:
GPS导航接收机、GLONASS导航接收机、GALILEO导航接收机和北斗导航接收机中的一种或者多种,用于接收对应的卫星信号;
融合电路,用于将一种或者多种导航接收机接收到的卫星信号进行时空归一化处理后,进行数据融合处理后输出作为GNSS系统的输出信号。
为了上述以及相关的目的,一个或多个实施例包括后面将详细说明并在权利要求中特别指出的特征。下面的说明以及附图详细说明某些示例性方面,并且其指示的仅仅是各个实施例的原则可以利用的各种方式中的一些方式。其它的益处和新颖性特征将随着下面的详细说明结合附图考虑而变得明显,所公开的实施例是要包括所有这些方面以及它们的等同。
附图说明
图1是本发明实施例一种组合导航设备结构图;
图2是本发明实施例组合导航设备中GNSS系统与SINS系统融合结构图;
图3是采用本发明实施例组合导航设备的组合导航方法流程图。
具体实施方式
以下描述和附图充分地示出本发明的具体实施方案,以使本领域的技术人员能够实践它们。其他实施方案可以包括结构的、逻辑的、电气的、过程的以及其他的改变。实施例仅代表可能的变化。除非明确要求,否则单独的组件和功能是可选的,并且操作的顺序可以变化。一些实施方案的部分和特征可以被包括在或替换其他实施方案的部分和特征。本发明的实施方案的范围包括权利要求书的整个范围,以及权利要求书的所有可获得的等同物。在本文中,本发明的这些实施方案可以被单独地或总地用术语“发明”来表示,这仅仅是为了方便,并且如果事实上公开了超过一个的发明,不是要自动地限制该应用的范围为任何单个发明或发明构思。
申请人注意到,在飞行器运行过程中,各种传感器都在时刻探测着飞行器自身和外界信息,由于这些信息本身之间是飞行器所处环境的映射,因此其具有很强的关联性,这种关联性反映到数据之上就代表着其数据之间具有互补、冗余特性。利用数据之间的互补性来提升探测系统性能是数据融合的核心目的。
因此,申请人在本申请中提出利用外部增强系统和传感器辅助信息提高卫星导航接收机输出导航信息完好性能。由外部增强信息和辅助信息为GNSS导航系统提供更精确的测量信息和冗余测量信息,从而提高机载导航设备的可用性和完好性。
申请人通过深入分析导航系统的数据来源和关联性,选择全球卫星导航系统(简称GNSS)和惯性导航系统(简称INS)进行融合,并选择机载高度表在融合过程提供精确的高度信息,从而使用3个导航卫星即可实现精确导航定位需求。从而能够大大提高机载导航设备的可用性和完好性
下面将对本发明所选择的多源信息进行分析:
(1)可利用惯性辅助提升机载完好性
惯性导航具有不受电磁干扰、独立自主输出载体导航信息和姿态信息的能力,其缺点是定位误差受初始对准精度影响较大,且误差随时间有积累。将惯导与卫星导航进行组合,可以利用卫星导航测量信息没有误差积累的优点对惯导误差进行修正,同时当采用紧组合方式时,短时间内可以在卫星数低于4颗情况下进行精确导航。惯导独立输出的定位结果给卫星导航提供了多种冗余信息,合理利用这些冗余信息不仅可以提高卫星导航定位精度,还可以对卫星测量伪距精度进行有效评估,从而可以提高机载卫星导航接收机的完好性。
当前卫星导航完好性大都是基于单颗卫星故障进行研究的,故障卫星越多需要的冗余信息越多,而惯导提供的冗余信息为多颗卫星故障监测提供了理想的解决途径。
(2)星基辅助提升机载完好性:
现有的四大GNSS系统分别是:我国正在建设的北斗第二代导航系统、美国的GPS系统、俄罗斯GLONASS系统和欧洲的GALILEO系统。随着全球卫星导航卫星系统的建设,可见卫星数目逐渐增多,同一历元时刻可见星从单GPS的10颗左右上升到近40颗。
星基辅助主要是指利用如GPS、GLONASS、GALILEO等的其它卫星导航系统及伪卫星系统来改善北斗系统星座分布、提供冗余测量信息从而可以增强机载北斗接收机的完好性能。
单星座导航系统由于卫星数目有限或是某些恶劣环境中信号受到严重干扰等问题,提供的卫星定位服务的精度、可靠性、安全性和可用性无法 得到保障。同时,各个卫星导航系统单独工作时可能存在难以覆盖的空白带,而且用户在使用过程中会受到主控国的限制。
由于例如GPS、GLONASS、GALILEO和北斗等这几种星基导航系统在系统构置、导航定位机理、工作频段、调制方式、信号和星历数据结构等在方面是基本相同和近似的,都以发射扩频测距码、测量卫星与用户之间的伪距来完成导航定位,所以就存在利用一部用户设备同时接收这四种卫星信号的可能性。如果能将多个系统组合使用,由于可用卫星数目增多,不仅能填补单一系统存在的覆盖空白问题,而且可使系统精度显著提高。
所谓星基组合定位,就是用一台接收机或者多个接收机同时接收和测量多个GNSS系统的卫星信号,然后进行数据融合处理。例如,目前可此采用GPS/GLONASS/GALILEO/北斗组合定位,就是用一台接收机或者多个接收机同时接收和测量GPS、GLONASS、GALILEO和北斗四种卫星信号,然后进行数据融合处理。从而实现在世界上任何地方、任何时间精确测出三维位置、三维速度、时间和姿态参数,为用户提供仅用单一卫星系统定位无法获得的性能。它将提高系统完善性、可靠性、定位精度以及导航连续性。
对于多星融合实现组合导航,需要进行如下设计:
1、共有接收射频资源设计:由于各GNSS系统,例如GPS/GLONASS/GALILEO/北斗之间的载波频率和码率上是不同的,需要设计一个能同时得到各GNSS系统的本振频率和钟频频率的频率综合器。
2、时空归一化处理:由于各GNSS系统,例如GPS/GLONASS/GALILEO/北斗系统的坐标系是不一致的,所以需要实现多星座系统的坐标系统一计算。同时上述四个系统的时间尺度也是不一致的,这也需要系统进行时间对准处理。而且在上述处理过程中不要将单一系统误差传递到最终的组合系统上来。
利用多卫星定位系统进行导航定位都是要基于一定的卫星几何分布,也就是首先需要知道卫星的空间位置,判断可用于导航定位的可见卫星数目和分布情况,再根据可见卫星的伪距或者载波相位等相关方法来求解用户位置。
卫星导航定位,是以卫星和用户接收机天线之间的距离观测量为基准,根据已知的卫星瞬时坐标,来确定用户接收机天线的位置。卫星导航定位 方法的实质是以星地空间距离为半径的三球交汇,因此,在一个观测站上,只需要3个独立距离观测量。
但是,由于各GNSS系统采用的都是单程测距原理,卫星钟与用户接收机时钟之间难以保持严格同步,受卫星钟和接收机时钟同步差的共同影响,实际上观测量不是观测站到卫星之间的真实距离,而是含有误差的伪距。当然,卫星钟差是可以通过卫星导航电文中所提供的相应钟差参数加以修正的,而接收机的钟差,由于精度低、随机性强,难以预先准确测定。所以,可将接收机的钟差作为一个未知参数与观测站坐标在数据处理中一并解出。因此,在一个观测站上,为了实时求解4个未知参数(3个用户坐标x、y、z和一个接收机时钟误差δt),至少需要同步观测4颗卫星。
在多星座组合导航定位中,需要同时接收多个卫星星座的导航电文信息,而由于各系统之间存在时间偏差,以及坐标系不同,而且接收机对不同系统信号的时延也不同,所以,在多星座组合导航中需要考虑时空统一问题,进而进行组合导航解算。
根据各个卫星星座仿真器输出的可见卫星的位置,给定用户初始近似位置信息,获得伪距观测量,按照上述介绍的多星座组合导航定位方法,进而可以求解含有定位误差的用户位置,实现多星座组合导航定位。
在我国不同纬度地区,GPS和GLONASS卫星导航系统的可见卫星数目分布在5~8颗,而GALILEO系统分布在8~11颗。因此,与GPS和GLONASS卫星导航系统相比,GALILEO系统具有一定的优势,相同环境下能观测到更多的可见卫星。与单星座系统相比,组合系统的可见卫星数目能增加几倍,在任何时段任何地点都能观测到18颗及以上的导航卫星,这样将有利于组成更好的卫星几何分布,在任何时段都能满足定位要求,提高定位精度。
(3)机载高度表辅助机载完好性
GNSS信号存在受遮挡引起失锁、抗干扰性能弱及数据滞后等问题,在高度方向的定位精度较差,因受对流层延迟影响在近地面时准确度更差;尤其其安全性可能受他国影响或人为干扰得不到保障。
气压高度表是飞行器不可或缺的仪表设备,具有不依赖外界信息、隐蔽性好、抗辐射性强、全天候等优点。气压高度表的短时精度较高,但会随着大气压与温度的变化而发生变化,随时间的变长会产生较大的高度测 量误差。
气压式高度表的工作原理是根据高度升高气压降低,利用真空膜盒感受大气压力的变化表示飞行高度的变化,当前在飞机上使用的高度表,他们的工作原理都是利用高度上升,气压降低的规律工作的。
由于机载高度表可以提供高度信息,所以可以通过增加一个高度表信息,再加上三个导航卫星信息即可完成。
考虑到各种信息其时空属性如采样率、数据形式、向融合中心报告的时间、对环境的描述、空间测量偏差等因素,本发明提供一种组合导航设备,如图1所示,包括全球卫星导航系统GNSS101、惯性导航系统INS102、机载高度表103、紧组合滤波电路104、松组合滤波电路105、运算电路106、信号处理电路107,其中:
紧组合滤波电路104,采用一卡尔曼EKF滤波器对GNSS系统101和INS系统102的数据进行紧组合滤波,输出两个系统融合后的数据,并计算紧组合滤波残差,据以生成残差序列和残差预测;
松组合滤波电路105,采用卡尔曼EKF滤波器将GNSS系统101与INS系统102融合后的数据与记载高度表103的数据进行松组合滤波,输出三个系统融合后的数据,并计算松组合滤波残差,据以生成残差序列和残差预测;
运算电路106,用于将紧组合滤波电路104和松组合滤波电路105生成的残差序列和残差预测构成EKF量测方程,执行导航误差状态估计;
信号处理电路107,用于根据导航误差状态估计检测GNSS系统完好性,并对GNSS系统的故障进行隔离和修正。
较佳地,所述INS系统采用捷联惯性导航SINS系统。
较佳地,还包括一反馈电路108,用于使用导航误差状态估计产生伪距测量值的校正值,据以对INS系统102的参数进行校正。
在一具体实施例中,GNSS系统与INS系统采用线性卡尔曼滤波器进行紧组合滤波,如图2所示。系统的状态方程为纯捷联惯性导航系统的误差方程。结合捷联惯性导航系统的基本导航参数误差方程以及惯性仪表的误差方程,可以获得惯性/卫星组合导航系统的状态方程为:
X(t)=F(t)X(t)+G(t)W(t)
式中F(t)表示惯性/卫星组合导航系统状态方程的一步状态转移矩阵;G(t)表示惯性/卫星组合导航系统状态方程的系统白噪声误差矩阵;W(t)为惯性/卫星组合导航系统状态方程的系统误差白噪声矢量,系统状态矢量定义为:
X=[φe,φn,φu,δve,δvn,δvu,δL,δλ,δh,εbx,εby,εbz,εrx,εry,εrz,▽x,▽y,▽z]T
式中φe,φn,φu表示三个惯性导航平台误差角;δve,δvn,δvu表示三个速度误差;δL,δλ,δh表示三个位置误差;εbx,εby,εbz,εrx,εry,εrz表示陀螺三个常值漂移误差和三个一阶马尔可夫漂移误差;▽x,▽y,▽z表示加速度计三个一阶马尔科夫漂移误差。
组合导航系统的白噪声矢量为:
W=[ωgx,ωgy,ωgz,ωrx,ωry,ωrz,ωax,ωay,ωaz]T
对应于白噪声矢量,白噪声方差矩阵Q(t)为:
组合导航系统噪声系数矩阵为:
组合导航系统的状态转移矩阵为:
上式中,
AINS对应9个基本导航参数的系统阵,由惯性导航系统的导航参数基本误差方程决定,其具体形式如下:
量测方程中的量测信息由惯性导航系统输出的三维速度、三维位置分别与卫星输出的三维速度、三维位置的差值构成,如下式所示,其中Rn和Re为参考椭球子午圈和卯酉圈上各点的曲率半径。
上式中:
Hv(t)3×18=[03×3 diag[1 1 1] 03×3 03×9]3×18
Hp(t)3×18=[03×3 03×3 diag[Rn RecosL 1] 03×9]3×18
子系统测量白噪声矢量为:
NGPS(t)=[MnGPS MeGPS MdGPS NnGPS NeGPS NdGPS]T
测量白噪声矢量方差阵为:
RGPS(t)=diag[σ2 vnGPS σ2 veGPS σ2 vdGPS σ2 pnGPS σ2 peGPS σ2 pdGPS]T
采用卡尔曼滤波进行惯性/卫星组合导航信息融合,其开环形式为:
时间更新算法:
量测更新算法:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
对开环滤波器引入控制项后变成闭环形式,在完全闭环修正时,滤波方程组变为:
时间更新算法:
量测更新算法:
基于可观测度分析的惯性/卫星组合导航系统卡尔曼滤波算法采用闭环模式,主要包括时间更新过程、量测更新过程以及自适应反馈校正过程。其中时间更新、量测更新如上式所示,自适应反馈校正算法为:
式中,表示卡尔曼滤波当前时刻状态估计值,ηi表示归一化的可观测度系数,表示用于对系统参数进行补偿的修正量。
其中,所述EKF滤波器执行导航误差状态估计时:
在一具体实施例中,全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
在一具体实施例中,INS系统可采用捷联惯性导航SINS系统。
采用本发明上述组合导航设备,能够将多源信息进行最优融合,利用所选取的多源数据的关联性和互补性,对GNSS导航系统的信号缺失补偿、提高对卫星信号的捕获和跟踪精度和提高系统抗干扰性,从而达到最终提高组合导航精度的目标。
下面将说明本发明实施例上述组合导航设备的工作流程,如图3所示,包括步骤:
步骤S301:获取设置于飞行器上的全球卫星导航系统GNSS、惯性导航系统INS、机载高度表的数据;
步骤S302:使用卡尔曼EKF滤波器对GNSS系统和INS系统的数据进行紧组合滤波,输出两个系统融合后的数据,并计算紧组合滤波残差,据以生成残差序列和残差预测;
步骤S303:使用EKF滤波器将GNSS系统与INS系统融合后的数据与记载高度表的数据进行松组合滤波,输出三个系统融合后的数据,并计算松组合滤波残差,据以生成残差序列和残差预测;
步骤S304:将紧组合滤波和松组合滤波生成的残差序列和残差预测构成EKF量测方程,执行导航误差状态估计,据以检测GNSS系统完好性,并对GNSS系统的故障进行隔离和修正。
较佳地,还可以包括步骤S305:使用导航误差状态估计产生伪距测量值的校正值,据以对INS系统的参数进行校正。
其中,在执行步骤S302时,设备采用开环设计方式时,进行导航误差状态估计还包括时间更新过程和量测更新过程,其中:
时间更新公式为:
量测更新公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
其中,在执行步骤S302时,设备采用闭环设计方式时,进行导航误差状态估计还包括时间更新过程、量测更新过程和自适应反馈校正过程,其中:
时间更新公式为:
量测更新公式为:
自适应反馈校正公式为:
在执行步骤S302时,进行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
其中,在执行步骤S304时,所述EKF滤波器执行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
较佳地,在执行步骤S301之前,还包括步骤S307和步骤S308(步骤S307和步骤S308图中未示出):
步骤S307:采用GPS导航接收机、GLONASS导航接收机、GALILEO导航接收机和北斗导航接收机中的一种或者多种分别接收对应的卫星信号;
步骤S308:将所述一种或者多种导航接收机接收到的卫星信号进行时空归一化处理后,进行数据融合处理后输出作为GNSS系统的输出信号。
根据所述公开的实施例,可以使得本领域技术人员能够实现或者使用本发明。对于本领域技术人员来说,这些实施例的各种修改是显而易见的,并且这里定义的总体原理也可以在不脱离本发明的范围和主旨的基础上应用于其他实施例。以上所述的实施例仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (8)
1.一种基于全球卫星导航系统GNSS、惯性导航系统INS和机载高度表的组合导航方法,其特征在于,包括:
获取设置于飞行器上的GNSS系统、INS系统和机载高度表的数据;
使用卡尔曼EKF滤波器对GNSS系统和INS系统的数据进行紧组合滤波,输出两个系统融合后的数据,并计算紧组合滤波残差,据以生成残差序列和残差预测;
使用EKF滤波器将GNSS系统与INS系统融合后的数据与机载高度表的数据进行松组合滤波,输出三个系统融合后的数据,并计算松组合滤波残差,据以生成残差序列和残差预测;
将紧组合滤波和松组合滤波生成的残差序列和残差预测构成EKF量测方程,执行导航误差状态估计,据以检测GNSS系统完好性,并对GNSS系统的故障进行隔离和修正。
2.如权利要求1所述的方法,其特征在于,还包括:
使用导航误差状态估计产生伪距测量值的校正值,据以对INS系统的参数进行校正。
3.如权利要求1所述的方法,其特征在于,所述EKF滤波器执行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵;
n表示自然数。
4.如权利要求1所述的方法,其特征在于:
采用GPS导航接收机、GLONASS导航接收机、GALILEO导航接收机和北斗导航接收机中的一种或者多种分别接收对应的卫星信号;
将所述一种或者多种导航接收机接收到的卫星信号进行时空归一化处理后,进行数据融合处理后输出作为GNSS系统的输出信号。
5.如权利要求1所述的方法,其特征在于:
所述INS系统采用捷联惯性导航SINS系统。
6.一种基于全球卫星导航系统GNSS、惯性导航系统INS和机载高度表的组合导航设备,其特征在于,包括:
设置于飞行器上的全球卫星导航系统GNSS、惯性导航系统INS、机载高度表;
紧组合滤波电路,采用卡尔曼EKF滤波器对GNSS系统和INS系统的数据进行紧组合滤波,输出两个系统融合后的数据,并计算紧组合滤波残差,据以生成残差序列和残差预测;
松组合滤波电路,采用卡尔曼EKF滤波器将GNSS系统与INS系统融合后的数据与机载高度表的数据进行松组合滤波,输出三个系统融合后的数据,并计算松组合滤波残差,据以生成残差序列和残差预测;
运算电路,用于将紧组合滤波电路和松组合滤波电路生成的残差序列和残差预测构成EKF量测方程,执行导航误差状态估计;
信号处理电路,用于根据导航误差状态估计检测GNSS系统完好性,并对GNSS系统的故障进行隔离和修正。
7.如权利要求6所述的设备,其特征在于,还包括:
反馈电路,用于使用导航误差状态估计产生伪距测量值的校正值,据以对INS系统的参数进行校正。
8.如权利要求6所述的设备,其特征在于,所述GNSS系统包括:
GPS导航接收机、GLONASS导航接收机、GALILEO导航接收机和北斗导航接收机中的一种或者多种,用于接收对应的卫星信号;
融合电路,用于将一种或者多种导航接收机接收到的卫星信号进行时空归一化处理后,进行数据融合处理后输出作为GNSS系统的输出信号。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610318680.0A CN105807303B (zh) | 2016-05-14 | 2016-05-14 | 基于gnss、ins和机载高度表的组合导航方法和设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610318680.0A CN105807303B (zh) | 2016-05-14 | 2016-05-14 | 基于gnss、ins和机载高度表的组合导航方法和设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105807303A CN105807303A (zh) | 2016-07-27 |
CN105807303B true CN105807303B (zh) | 2018-12-21 |
Family
ID=56457050
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610318680.0A Active CN105807303B (zh) | 2016-05-14 | 2016-05-14 | 基于gnss、ins和机载高度表的组合导航方法和设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105807303B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108287354B (zh) * | 2017-01-09 | 2020-09-08 | 北京四维图新科技股份有限公司 | 一种数据自动纠错方法和装置及导航设备 |
CN108844539A (zh) * | 2018-05-28 | 2018-11-20 | 哈尔滨工程大学 | 一种用于海浪主动补偿系统的位姿检测系统 |
IT201900025399A1 (it) * | 2019-12-23 | 2021-06-23 | St Microelectronics Srl | Procedimento per provvedere informazione di navigazione, corrispondente sistema e prodotto informatico |
CN111024124B (zh) * | 2019-12-25 | 2023-11-07 | 南京航空航天大学 | 一种多传感器信息融合的组合导航故障诊断方法 |
CN111780750B (zh) * | 2020-06-08 | 2022-10-28 | 中国民用航空中南地区空中交通管理局 | 基于多传感器的民航客机高精度定位方法、设备、介质 |
CN112146659A (zh) * | 2020-09-24 | 2020-12-29 | 北京星际荣耀空间科技有限公司 | 一种组合导航系统的滤波方法、装置及存储介质 |
CN113703026B (zh) * | 2021-10-28 | 2022-02-08 | 中国商用飞机有限责任公司 | 用于飞行器的导航模式选择的方法和系统 |
CN114689054B (zh) * | 2022-02-24 | 2023-06-20 | 中国电子科技集团公司第十研究所 | 塔康系统高精度导航方法、装置、飞行设备及存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1361409A (zh) * | 2000-12-23 | 2002-07-31 | 林清芳 | 增强型导航定位之方法及其系统 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航系统 |
CN206002114U (zh) * | 2016-05-14 | 2017-03-08 | 中卫物联成都科技有限公司 | 一种基于多源信息融合的组合导航设备 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101629997A (zh) * | 2009-07-24 | 2010-01-20 | 南京航空航天大学 | 惯性辅助卫星导航完好性检测装置及检测方法 |
US8756001B2 (en) * | 2011-02-28 | 2014-06-17 | Trusted Positioning Inc. | Method and apparatus for improved navigation of a moving platform |
CN102937449B (zh) * | 2012-10-19 | 2015-01-14 | 南京航空航天大学 | 惯性导航系统中跨音速段气压高度计和gps信息两步融合方法 |
-
2016
- 2016-05-14 CN CN201610318680.0A patent/CN105807303B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1361409A (zh) * | 2000-12-23 | 2002-07-31 | 林清芳 | 增强型导航定位之方法及其系统 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航系统 |
CN206002114U (zh) * | 2016-05-14 | 2017-03-08 | 中卫物联成都科技有限公司 | 一种基于多源信息融合的组合导航设备 |
Non-Patent Citations (1)
Title |
---|
大气辅助的SINS/GPS组合导航系统研究;李荣冰 等;《仪器仪表学报》;20120930;第33卷(第9期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN105807303A (zh) | 2016-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105807303B (zh) | 基于gnss、ins和机载高度表的组合导航方法和设备 | |
CN105806339B (zh) | 一种基于gnss、ins和守时系统的组合导航方法和设备 | |
CN105911567B (zh) | 一种gnss系统完好性评估方法和装置 | |
CN206002114U (zh) | 一种基于多源信息融合的组合导航设备 | |
CN105758401A (zh) | 一种基于多源信息融合的组合导航方法和设备 | |
US8311728B2 (en) | Navigation system using hybridization by phase measurements | |
RU2621827C2 (ru) | Бортовая система содействия пилотированию летательного аппарата, основанная на системе gnss, имеющая избыточную и несходную архитектуру для повышенного уровня достоверности | |
EP1690067B1 (en) | System and method for using multiple aiding sensors in a deeply integrated navigation system | |
US7769543B2 (en) | Fault detection and reconfiguration of an automated refueling boom | |
Hasan et al. | A review of navigation systems (integration and algorithms) | |
US8497798B2 (en) | Device and method for three-dimensional positioning | |
CN205643716U (zh) | 一种导航信号接收机 | |
CN106501832A (zh) | 一种容错矢量跟踪gnss/sins深组合导航方法 | |
Sun et al. | Ultratight GPS/reduced-IMU integration for land vehicle navigation | |
Bhatti | Improved integrity algorithms for integrated GPS/INS systems in the presence of slowly growing errors | |
Zuo et al. | A GNSS/IMU/vision ultra-tightly integrated navigation system for low altitude aircraft | |
Jia | Data fusion methodologies for multisensor aircraft navigation systems | |
Emel’yantsev et al. | Specific features of constructing a dual-mode GNSS gyrocompass as a tightly-coupled integrated system | |
Tenny et al. | Robust Navigation for Urban Air Mobility via Tight Coupling of GNSS with Terrestrial Radionavigation and Inertial Sensing | |
Liu et al. | Integrity monitoring using ERAIM for GNSS/inertial system | |
Almagbile | GNSS/INS integration for positioning and navigation: Modelling and quality analysis | |
RU2389042C2 (ru) | Способ определения защитного предела вокруг местоположения движущегося тела, вычисленного по спутниковым сигналам | |
Skaloud | Reliability of Direct Georeferencing Phase 1: An Overview of the Current Approaches and Possibilities., Checking and Improving of Digital Terrain Models/Reliability of Direct Georeferencing. | |
Da | Analysis and test results of AIMS GPS/INS system | |
Bin et al. | Adaptive Robust UKF Algorithm and Its Application in MIMU/GPS Initial Alignment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |