CN105806339B - 一种基于gnss、ins和守时系统的组合导航方法和设备 - Google Patents
一种基于gnss、ins和守时系统的组合导航方法和设备 Download PDFInfo
- Publication number
- CN105806339B CN105806339B CN201610321377.6A CN201610321377A CN105806339B CN 105806339 B CN105806339 B CN 105806339B CN 201610321377 A CN201610321377 A CN 201610321377A CN 105806339 B CN105806339 B CN 105806339B
- Authority
- CN
- China
- Prior art keywords
- navigation
- gnss
- indicated
- estimation
- time
- 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
- 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)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种基于GNSS系统、INS系统和守时系统的组合导航方法和设备,该方法包括:分别从GNSS系统和INS系统获取导航数据;在ECI为导航坐标系下,计算GNSS系统伪距测量结果与根据相应的INS系统导航结算得到的伪距预测结果之差,和GNSS伪距率与根据相应的INS系统导航结算得到的伪距率之差;综合所述两差值构成EKF量测方程,执行导航误差状态估计;从机载守时系统获取时间信息,据以对EKF滤波器输出的导航误差估计进行评估与修正,据以产生伪距测量值的校正值;使用所述伪距测量值的校正值对INS系统的参数进行校正。该方法能够有效提高机载导航设备的可用性和完好性。
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滤波器、修正电路和反馈电路,其中:
所述EKF滤波器,用于对GNSS系统和INS系统进行紧组合滤波,包括:获取以ECI为导航坐标系下,GNSS系统伪距测量结果与根据相应的INS系统导航结算得到的伪距预测结果之差,和GNSS伪距率与根据相应的INS系统导航结算得到的伪距率之差,综合所述两差值构成EKF量测方程,执行导航误差状态估计;
修正电路,用于从机载守时系统获取时间信息,据以对EKF滤波器输出的导航误差估计进行评估与修正,据以产生伪距测量值的校正值;
所述反馈电路,用于使用所述伪距测量值的校正值对INS系统的参数进行校正。
较佳地,所述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)表示量测噪声阵。
较佳地,所述EKF滤波器执行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
较佳地,所述GNSS系统包括:
GPS导航接收机、GLONASS导航接收机、GALILEO导航接收机和北斗导航接收机中的一种或者多种,用于接收对应的卫星信号;
融合电路,用于将一种或者多种导航接收机接收到的卫星信号进行时空归一化处理后,进行数据融合处理后输出作为GNSS系统的输出信号。
较佳地,INS系统采用捷联惯性导航SINS系统。
本发明还提供了一种基于GNSS、INS和守时系统的组合导航方法,包括:
在ECI为导航坐标系下,计算GNSS系统伪距测量结果与根据相应的INS系统导航结算得到的伪距预测结果之差,和GNSS伪距率与根据相应的INS系统导航结算得到的伪距率之差;
综合所述两差值构成EKF量测方程,执行导航误差状态估计;
从机载守时系统获取时间信息,据以对EKF滤波器输出的导航误差估计进行评估与修正,据以产生伪距测量值的校正值;
使用所述伪距测量值的校正值对INS系统的参数进行校正。
较佳地,采用开环方式进行导航误差状态估计时,还包括时间更新过程和量测更新过程,其中:
时间更新公式为:
量测更新公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
较佳地,采用闭环方式进行导航误差状态估计时,还包括时间更新过程、量测更新过程和自适应反馈校正过程,其中:
时间更新公式为:
量测更新公式为:
自适应反馈校正公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
较佳地,进行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
为了上述以及相关的目的,一个或多个实施例包括后面将详细说明并在权利要求中特别指出的特征。下面的说明以及附图详细说明某些示例性方面,并且其指示的仅仅是各个实施例的原则可以利用的各种方式中的一些方式。其它的益处和新颖性特征将随着下面的详细说明结合附图考虑而变得明显,所公开的实施例是要包括所有这些方面以及它们的等同。
附图说明
图1是本发明实施例一种组合导航设备结构图;
图2是本发明实施例组合导航设备中GNSS系统与SINS系统融合结构图;
图3是采用本发明实施例组合导航设备的组合导航方法流程图。
具体实施方式
以下描述和附图充分地示出本发明的具体实施方案,以使本领域的技术人员能够实践它们。其他实施方案可以包括结构的、逻辑的、电气的、过程的以及其他的改变。实施例仅代表可能的变化。除非明确要求,否则单独的组件和功能是可选的,并且操作的顺序可以变化。一些实施方案的部分和特征可以被包括在或替换其他实施方案的部分和特征。本发明的实施方案的范围包括权利要求书的整个范围,以及权利要求书的所有可获得的等同物。在本文中,本发明的这些实施方案可以被单独地或总地用术语“发明”来表示,这仅仅是为了方便,并且如果事实上公开了超过一个的发明,不是要自动地限制该应用的范围为任何单个发明或发明构思。
申请人注意到,在飞行器运行过程中,各种传感器都在时刻探测着飞行器自身和外界信息,由于这些信息本身之间是飞行器所处环境的映射, 因此其具有很强的关联性,这种关联性反映到数据之上就代表着其数据之间具有互补、冗余特性。利用数据之间的互补性来提升探测系统性能是数据融合的核心目的。
因此,申请人在本申请中提出利用外部增强系统和传感器辅助信息提高卫星导航接收机输出导航信息完好性能。由外部增强信息和辅助信息为GNSS导航系统提供更精确的测量信息和冗余测量信息,从而提高机载导航设备的可用性和完好性。
申请人通过深入分析导航系统的数据来源和关联性,选择全球卫星导航系统(简称GNSS)和惯性导航系统(简称INS)进行融合,并选择机载守时系统在融合过程提供精确的时间信息,从而能够大大提高机载导航设备的可用性和完好性
下面将对本发明所选择的多源信息进行分析:
(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实现对接收机与GNSS信号偏差的计算,避免了对时间偏差的估计,这样就可以采用三个卫星信号完成定位解算。如果卫星信号 增加,则利用机载守时系统将实现对故障信号的检测与隔离修正,从而提高系统的完好性。
本发明通过将飞行器所携带的GNSS导航系统、INS导航系统和机载守时系统等来形成组合导航系统,用以完成对GNSS导航系统的信号缺失补偿、提高对卫星信号的捕获和跟踪精度和提高系统抗干扰性,从而达到最终提高组合导航精度的目标。
多源信息虽然具有互补性,但是其时空属性如采样率、数据形式、向融合中心报告的时间、对环境的描述、空间测量偏差等往往不一致,在进行信息融合之前需要完成对信息的时空对准,即将信息转换为相同的形式、相同的参照、相同的描述之后,才能完成信息融合处理。
时间配准指的是将各传感器时间同步到统一基准时标下,并将不同步的量测信息配准到同一融合时刻。时间系统是复杂的系统,现行的时间系统主要有恒星时(siderealtime,ST)、世界时(universal time,UT)、历书时(ephemeris time,ET)、国际原子时(international atomic time,TAI)、协调世界时(coordinate universal time,UTC)、地球动力学时(terrestrial dynamic time,TDT)和质心动力学时(barycenter dynamictime,TDB)。导航系统的时间同步采用UTC作为基准。
在组合导航系统中,时间误差主要来自于三个方面:
1、各传感器时间基准之间的误差,由于各传感器时钟精度不同形成的时间偏差,这部分误差目前通常通过时间统一装置进行补偿,补偿后误差较小。
2、各传感器开机时刻和采样周期是不一致的,它们向融合中心报告的时刻往往也是不相同的,造成了不同步误差。
3、各传感器量测信息和时间基准统一信号都会在通信中有延时,而且由于数据传输的复杂性,即使是同一网络,通信延迟时间也不同,仍会造成时间不同步。
为分析时间误差对导航系统造成的影响,以INS和GPS组合系统为例进行理论分析。首先考虑时间误差对速度的影响,根据速度误差方程:
其中,f是比力,▽是加速度计误差,Cn b是方向余弦矩阵。在姿态角为小量时,
于是可得:
又有姿态误差方程为:
其中,
使用间接法建立观测方程,速度观测量应为:
当时,即载体静止或匀速直线运动时,观测方程不受时间误差的影响。
当时,忽略高度通道,得简化的速度状态:
考虑两种代表性运动,直线加速运动和圆周运动。
当载体直线加速运动时,速度状态变为:
其滤波稳态时,有:
由上面两式知,直线加速运动时,时间误差将对速度估计造成影响,由于时间误差本身是小量,在加速度变化不大时,其影响不大。
当载体圆周运动时,速度状态变为:
其滤波稳态时,有:
此时,时间误差与方位角具有信息的一致特征性,滤波时,会把时间误差归因于方位角,从而直接造成方位角估计错误,给速度估计带来较大 的误差。
综上,时间误差对速度的影响主要原因是载体的牵连加速度,当载体机动时,时间误差会对速度估计造成影响。
然后分析时间误差对位置的影响,考虑到速度与位置的积分关系,因此可以简化分析过程。
位置误差的表达式为:
位置观测量为:
其中,是时间差在位置观测上造成的外观测误差,P(Δt)可视为直接对位置估计造成影响的时间误差如起始时刻误差等。由可知,当载体加速度变化时(包括线速度和角速度),会产生速度观测量的直接误差。由速度造成的误差分量会直接积分到位置中,因此可知时间误差在组合导航系统中的作用不容轻易忽视。
空间配准不仅包括传感器的坐标系统一,即将各传感器坐标系中的信息变换到统一的导航坐标系中;而且包括校正各传感器因空间位置所造成的相对偏差。空间配准有两个配准任务:坐标系统一和传感器空间偏差校正。
空间误差来源主要有:
1不同坐标系体系存在定位偏差;
2各导航传感器参考坐标系不一;
3传感器测量单元或天线处于不同位置所造成的空间测量偏差;
4受载体扭曲形变影响造成的空间测量偏差。
考虑到各种信息其时空属性如采样率、数据形式、向融合中心报告的时间、对环境的描述、空间测量偏差等因素,本发明提供一种组合导航设备,如图1所示,包括全球卫星导航系统(GNSS)101、惯性导航系统(INS)102、机载守时系统103、卡尔曼(EKF)滤波器104、修正电路105和反馈电路106,其中:
所述EKF滤波器104,用于对GNSS系统101和INS系统102进行紧组合滤波,包括:获取以ECI为导航坐标系下,GNSS系统101伪距测量结果与根据相应的INS系统102导航解算得到的伪距预测结果之差,和GNSS101伪距率与根据相应的INS系统102导航结算得到的伪距率之差,综合所述两差值构成EKF量测方程,执行导航误差状态估计;
修正电路105,用于从机载守时系统103获取时间信息,据以对EKF滤波器104输出的导航误差估计进行评估与修正,据以产生伪距测量值的校正值;
所述反馈电路106,用于使用所述伪距测量值的校正值对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:在ECI为导航坐标系下,计算GNSS系统伪距测量结果与根据相应的INS系统导航结算得到的伪距预测结果之差,和GNSS伪距率与根据相应的INS系统导航结算得到的伪距率之差;
步骤S303:综合所述两差值构成EKF量测方程,执行导航误差状态估计;
步骤S304:从机载守时系统获取时间信息,据以对EKF滤波器输出的导航误差估计进行评估与修正,据以产生伪距测量值的校正值;
步骤S305:使用所述伪距测量值的校正值对INS系统的参数进行校正。
在执行步骤S303时,设备采用开环设计方式时,进行导航误差状态估计还包括时间更新过程和量测更新过程,其中:
时间更新公式为:
量测更新公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
在执行步骤S303时,设备采用闭环设计方式时,进行导航误差状态估计还包括时间更新过程、量测更新过程和自适应反馈校正过程,其中:
时间更新公式为:
量测更新公式为:
自适应反馈校正公式为:
在执行步骤S303时,进行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
根据所述公开的实施例,可以使得本领域技术人员能够实现或者使用本发明。对于本领域技术人员来说,这些实施例的各种修改是显而易见的,并且这里定义的总体原理也可以在不脱离本发明的范围和主旨的基础上应用于其他实施例。以上所述的实施例仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于全球卫星导航系统GNSS、惯性导航系统INS和守时系统的组合导航设备,其特征在于,包括GNSS系统、INS系统、机载守时系统、卡尔曼EKF滤波器、修正电路和反馈电路,其中:
所述EKF滤波器,用于对GNSS系统和INS系统进行紧组合滤波,包括:获取以ECI为导航坐标系下,GNSS系统伪距测量结果与根据相应的INS系统导航结算得到的伪距预测结果之差,和GNSS伪距率与根据相应的INS系统导航结算得到的伪距率之差,综合两差值构成EKF量测方程,执行导航误差状态估计;
修正电路,用于从守时系统获取时间信息,据以对EKF滤波器输出的导航误差估计进行评估与修正,据以产生伪距测量值的校正值;
所述反馈电路,用于使用所述伪距测量值的校正值对INS系统的参数进行校正。
2.如权利要求1的设备,其特征在于,所述EKF滤波器对GNSS系统和INS系统进行紧组合滤波时采用开环形式,包括时间更新过程和量测更新过程,其中:
时间更新公式为:
量测更新公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
3.如权利要求1的设备,其特征在于,所述EKF滤波器对GNSS系统和INS系统进行紧组合滤波时采用闭环形式,包括时间更新过程、量测更新过程和自适应反馈校正过程,其中:
时间更新公式为:
量测更新公式为:
自适应反馈校正公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
4.如权利要求1所述的设备,其特征在于,所述EKF滤波器执行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
5.如权利要求1所述的设备,其特征在于,所述GNSS系统包括:
GPS导航接收机、GLONASS导航接收机、GALILEO导航接收机和北斗导航接收机中的一种或者多种,用于接收对应的卫星信号;
融合电路,用于将一种或者多种导航接收机接收到的卫星信号进行时空归一化处理后,进行数据融合处理后输出作为GNSS系统的输出信号。
6.如权利要求1所述的设备,其特征在于:
INS系统采用捷联惯性导航SINS系统。
7.一种基于GNSS、INS和守时系统的组合导航方法,其特征在于,包括:
分别从GNSS系统和INS系统获取导航数据;
在ECI为导航坐标系下,计算GNSS系统伪距测量结果与根据相应的INS系统导航结算得到的伪距预测结果之差,和GNSS伪距率与根据相应的INS系统导航结算得到的伪距率之差;
综合两差值构成EKF量测方程,执行导航误差状态估计;
从守时系统获取时间信息,据以对EKF滤波器输出的导航误差估计进行评估与修正,据以产生伪距测量值的校正值;
使用所述伪距测量值的校正值对INS系统的参数进行校正。
8.如权利要求7所述的方法,其特征在于,采用开环方式进行导航误差状态估计时,还包括时间更新过程和量测更新过程,其中:
时间更新公式为:
量测更新公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
9.如权利要求7所述的方法,其特征在于,采用闭环方式进行导航误差状态估计时,还包括时间更新过程、量测更新过程和自适应反馈校正过程,其中:
时间更新公式为:
量测更新公式为:
自适应反馈校正公式为:
其中:
表示系统当前时刻状态估计值;
表示系统状态一步预测值;
Ki(k)表示系统当前时刻滤波增益阵;
Pi(k/k-1)表示系统状态一步预测误差估计协方差阵;
Pi(k/k)表示系统状态误差估计协方差阵;
Qi(k-1)表示系统状态噪声阵;
Ri(k)表示量测噪声阵。
10.如权利要求7所述的方法,其特征在于,进行导航误差状态估计时:
全局的最优估计值公式为:
最优估计方差阵公式为:
其中:
表示系统当前时刻状态估计值;
Pi(k/k)表示系统状态误差估计协方差阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610321377.6A CN105806339B (zh) | 2016-05-14 | 2016-05-14 | 一种基于gnss、ins和守时系统的组合导航方法和设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610321377.6A CN105806339B (zh) | 2016-05-14 | 2016-05-14 | 一种基于gnss、ins和守时系统的组合导航方法和设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105806339A CN105806339A (zh) | 2016-07-27 |
CN105806339B true CN105806339B (zh) | 2018-09-25 |
Family
ID=56451270
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610321377.6A Active CN105806339B (zh) | 2016-05-14 | 2016-05-14 | 一种基于gnss、ins和守时系统的组合导航方法和设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105806339B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109085619B (zh) * | 2017-06-14 | 2020-09-25 | 展讯通信(上海)有限公司 | 多模gnss系统的定位方法及装置、存储介质、接收机 |
CN107783155A (zh) * | 2017-10-19 | 2018-03-09 | 杨锐 | 一种低成本无人机抗诱捕导航系统 |
CN108226980B (zh) * | 2017-12-23 | 2022-02-08 | 北京卫星信息工程研究所 | 基于惯性测量单元的差分gnss与ins自适应紧耦合导航方法 |
CN109059911B (zh) * | 2018-07-31 | 2021-08-13 | 太原理工大学 | 一种gnss、ins和气压计的数据融合方法 |
CN110285834B (zh) * | 2019-07-08 | 2022-12-13 | 哈尔滨工程大学 | 基于一点位置信息的双惯导系统快速自主重调方法 |
CN112394377A (zh) * | 2019-08-14 | 2021-02-23 | Oppo广东移动通信有限公司 | 导航方法、装置、电子设备及存储介质 |
CN111443363B (zh) * | 2020-01-17 | 2023-07-04 | 中国人民解放军战略支援部队信息工程大学 | 一种卫星导航的欺骗识别方法及装置 |
WO2021174485A1 (en) * | 2020-03-05 | 2021-09-10 | Baidu.Com Times Technology (Beijing) Co., Ltd. | Latency compensation in inertial navigation system |
CN113009816B (zh) * | 2021-03-08 | 2022-06-21 | 北京信息科技大学 | 时间同步误差的确定方法及装置、存储介质及电子装置 |
CN114964220A (zh) * | 2022-04-06 | 2022-08-30 | 广东省国土资源测绘院 | 一种无人机定位、定姿数据采集方法、装置及无人机 |
CN115408652B (zh) * | 2022-10-31 | 2023-02-03 | 北京航空航天大学 | 一种基于截断误差估计的ekf组合导航保护级确定方法 |
CN116718153B (zh) * | 2023-08-07 | 2023-10-27 | 成都云智北斗科技有限公司 | 一种基于gnss和ins的形变监测方法及系统 |
CN117590441B (zh) * | 2024-01-16 | 2024-04-30 | 广州导远电子科技有限公司 | 一种完好性保护水平计算方法及相关设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN104459747A (zh) * | 2014-12-19 | 2015-03-25 | 北京临近空间飞艇技术开发有限公司 | 一种gnss/ins组合导航方法及系统 |
CN104931995A (zh) * | 2015-06-12 | 2015-09-23 | 南京理工大学 | 一种基于矢量跟踪的gnss/sins深组合导航方法 |
CN105068102A (zh) * | 2015-08-11 | 2015-11-18 | 南京理工大学 | 一种基于dsp+fpga的超紧组合导航方法 |
CN105549057A (zh) * | 2015-12-07 | 2016-05-04 | 韩厚增 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
-
2016
- 2016-05-14 CN CN201610321377.6A patent/CN105806339B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN104459747A (zh) * | 2014-12-19 | 2015-03-25 | 北京临近空间飞艇技术开发有限公司 | 一种gnss/ins组合导航方法及系统 |
CN104931995A (zh) * | 2015-06-12 | 2015-09-23 | 南京理工大学 | 一种基于矢量跟踪的gnss/sins深组合导航方法 |
CN105068102A (zh) * | 2015-08-11 | 2015-11-18 | 南京理工大学 | 一种基于dsp+fpga的超紧组合导航方法 |
CN105549057A (zh) * | 2015-12-07 | 2016-05-04 | 韩厚增 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105806339A (zh) | 2016-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105806339B (zh) | 一种基于gnss、ins和守时系统的组合导航方法和设备 | |
CN206002114U (zh) | 一种基于多源信息融合的组合导航设备 | |
CN105758401A (zh) | 一种基于多源信息融合的组合导航方法和设备 | |
CN105911567B (zh) | 一种gnss系统完好性评估方法和装置 | |
CN105807303B (zh) | 基于gnss、ins和机载高度表的组合导航方法和设备 | |
Khanafseh et al. | GPS spoofing detection using RAIM with INS coupling | |
Hasan et al. | A review of navigation systems (integration and algorithms) | |
CN110715660B (zh) | 基于卡尔曼滤波估计的北斗/惯性组合抗欺骗干扰方法 | |
EP1690067B1 (en) | System and method for using multiple aiding sensors in a deeply integrated navigation system | |
US8497798B2 (en) | Device and method for three-dimensional positioning | |
Benzerrouk et al. | Alternative PNT based on Iridium Next LEO satellites Doppler/INS integrated navigation system | |
US20110238308A1 (en) | Pedal navigation using leo signals and body-mounted sensors | |
Konrad et al. | Advanced state estimation for navigation of automated vehicles | |
US20020116125A1 (en) | Positioning & data integrating method and system thereof | |
CA2715963A1 (en) | Navigation system using hybridization by phase measurements | |
Sun et al. | Ultratight GPS/reduced-IMU integration for land vehicle navigation | |
CN106813664A (zh) | 一种车载导航方法和装置 | |
Jia et al. | Ground vehicle navigation integrity monitoring for multi-constellation GNSS fused with cellular signals of opportunity | |
Zuo et al. | A GNSS/IMU/vision ultra-tightly integrated navigation system for low altitude aircraft | |
Chi et al. | Enabling robust and accurate navigation for UAVs using real-time GNSS precise point positioning and IMU integration | |
Du et al. | Integration of PPP GPS and low cost IMU | |
Jia | Data fusion methodologies for multisensor aircraft navigation systems | |
Li et al. | Inertial aided cycle slip detection and repair for PPP/INS tightly coupled navigation | |
Kube et al. | GNSS-based curved landing approaches with a virtual receiver | |
Tenny et al. | Robust Navigation for Urban Air Mobility via Tight Coupling of GNSS with Terrestrial Radionavigation and Inertial Sensing |
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 |