CN104316947B - Gnss/ins超紧组合导航装置及相对导航*** - Google Patents
Gnss/ins超紧组合导航装置及相对导航*** Download PDFInfo
- Publication number
- CN104316947B CN104316947B CN201410426136.9A CN201410426136A CN104316947B CN 104316947 B CN104316947 B CN 104316947B CN 201410426136 A CN201410426136 A CN 201410426136A CN 104316947 B CN104316947 B CN 104316947B
- Authority
- CN
- China
- Prior art keywords
- carrier
- gnss
- ins
- error
- state
- 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.)
- Expired - Fee Related
Links
- 238000005259 measurement Methods 0.000 claims abstract description 34
- 239000000969 carrier Substances 0.000 claims abstract description 20
- 238000001914 filtration Methods 0.000 claims abstract description 10
- 239000013598 vector Substances 0.000 claims description 43
- 238000012545 processing Methods 0.000 claims description 31
- 230000005540 biological transmission Effects 0.000 claims description 21
- 238000010276 construction Methods 0.000 claims description 16
- 230000001133 acceleration Effects 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 11
- 230000010354 integration Effects 0.000 claims description 10
- 238000000034 method Methods 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 6
- 230000003111 delayed effect Effects 0.000 claims description 4
- 230000017105 transposition Effects 0.000 claims description 3
- 230000015572 biosynthetic process Effects 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 4
- 238000012546 transfer Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 150000001875 compounds Chemical class 0.000 description 3
- 238000012938 design process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000004927 fusion Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000013508 migration Methods 0.000 description 2
- 230000005012 migration Effects 0.000 description 2
- -1 INS compound Chemical class 0.000 description 1
- 230000004913 activation Effects 0.000 description 1
- 230000003321 amplification Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000005436 troposphere Substances 0.000 description 1
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
- 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/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
- G01S19/44—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
-
- 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/51—Relative positioning
-
- 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/52—Determining velocity
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种GNSS/INS超紧组合导航装置及相对导航***。GNSS/INS超紧组合导航装置在传统GNSS/INS超紧组合导航装置的基础上,采用分布式滤波结构先利用从滤波器对每个卫星通道I,Q信号进行预处理,再将处理后的信息发送至组合滤波器;同时,将GNSS/INS超紧组合导航装置应用到相对导航***中,通过接收载体自身的导航状态、惯性测量,同时接收其它载体导航信息及载波相位,利用双差载波相位和惯性测量,采用最优卡尔曼滤波器进行递推滤波解算,估计多载体中每两个载体之间的最优相对位置与相对速度。
Description
技术领域
本发明属于导航领域,更加地说是GNSS/INS超紧组合导航装置及相对导航***。
背景技术
全球导航卫星***GNSS(Global Navigation Satellite System),惯性导航***INS(InertialNavigationSystem);GNSS/INS超紧组合导航是近几年组合导航的研究热点。卫星导航和惯性导航具有互补优势,两者组合方式可以有效地解决卫星导航信号受地理位置和环境干扰,和惯性导航***测量误差随时间累计等问题。GNSS/INS组合方式有松散组合,紧组合和超紧组合方式。其中,超紧组合方式是该领域的研究热点。此方式利用了惯性导航信息对GNSS信号捕获跟踪的辅助,实现了GNSS信息跟踪参数和惯性导航位置与速度之间的信息融合。在复杂环境下,GNSS/INS超紧组合***具有较强的抗干扰能力,可以为复杂状况下的运动载体,提供精确和稳定的导航定位、姿态确定和惯性对准等重要功能。
目前GNSS/INS超紧组合导航滤波结构多数属于集中式数据处理。通常I,Q信号的频率在MHz量级,而惯性输出在100Hz量级,集中式处理直接将两种信息集中处理,处理难度大,不易实现。
分布式导航***是一种新的导航***设计理念。分布式导航是将多个导航载体看成一个导航***,通过导航***里多个载体之间导航信息的相互交换和信息共享来提高整个***的导航精度,同时提高***的故障容错水平。分布式导航***可以分为集中式结构和分布式结构。Lead-Follower结构是一种常见的集中式结构,其思想是将某个导航载体作为领队导航终端,其它的作为跟随导航载体,各个导航终端之间的信息是向上可见,向下不可见的。分布式结构各个导航载体同处一个级别,各个载体的导航信息发送至数据处理中统一处理。分布式导航在机群协调编队中应用非常广泛。
相对导航***主要用于卫星编队飞行、自主交会对接任务和机群协同编队的相对导航信息的获取。目前,基于视觉的相对导航***常用于卫星自主交会对接任务中。
相对导航***是机群协同编队飞行的关键技术。飞行载体之间的相对导航信息的获取是保证编队飞行队形保持和变换的必要条件。其精度也会对编队飞行效果产生很大的影响。传统的相对导航多依赖卫星导航***且自主性比较差。卫星导航信号易受外界干扰,可靠性无法得到保证,一旦卫星信号受到干扰,相对导航精度下降很快。如何提高相对导航的精度同时增强飞行自主性和稳定性是目前相对导航研究的难点。
发明内容
为了解决目前GNSS/INS超紧组合导航滤波结构多数属于集中式数据处理,对数据处理速度要求很高,***复杂实现难度大的问题,本发明提供了一种GNSS/INS超紧组合导航装置,该装置于分布式滤波结构来实现,包括GNSS射频前端、惯性测量单元、跟踪捕获环路单元和组合滤波器;组合滤波器分别与惯性测量单元、跟踪捕获环路单元相连,跟踪捕获环路单元还与GNSS射频前端相连;
其中,跟踪捕获环路单元包括若干个可见卫星通道,每个可见卫星通道对应一个积分处理单元和从滤波器;GNSS射频前端接收并处理卫星信号数据后将数据发送至跟踪捕获环路单元,跟踪捕获环路单元中各可见卫星通道的I、Q信号经过对应的积分处理单元处理后发送至对应的从滤波器进行预处理得到从滤波器的状态向量;组合滤波器接收惯性测量单元的测量信息和从滤波器的状态向量,利用接收到的信息估计出该载体状态信息和载波相位并生成环路控制指令对跟踪捕获环路单元进行控制,其中所述载体状态信息包括位置、速度和姿态。
进一步地优选方案,本发明GNSS/INS超紧组合导航装置中,从滤波器处理当前、超前和滞后的I,Q信号;
从滤波器的状态向量Xi=[δwi δφi δti Mi]T,其中δwi为载波频率估计误差,δφi是载波相位估计误差,δti为码相位估计误差,Mi为信号的载波幅度,i为从滤波器对应的可见卫星通道数,i=1,2,...N,N为可见卫星通道数,[]T表示矩阵转置;
从滤波器中观测量Zi为积分周期T内当前I,Q信号值、超前I,Q信号值和滞后I,Q信号值,表示为:
其中,T0为积分周期的起始时刻,ε是接收机产生伪随机码的超前与滞后量之间的时间偏移。
进一步地优选方案,本发明GNSS/INS超紧组合导航装置中,组合滤波器的状态向量
其中,δx为位置误差状态,δv为速度误差状态,为姿态误差状态,δw为陀螺仪误差姿态向量,δa为加速度误差状态向量;δtu为接收机的时钟偏差,δtr是接收机的时钟随机漂移误差量;
组合滤波器的量测向量为:
其中,δρi和分别是GNSS和INS输出的伪距之差和伪距率之差。
同时本发明为了解决传统的相对导航多依赖卫星导航***且自主性比较差的问题,本发明还提供了一种基于GNSS/INS超紧组合导航装置的相对导航***,该***用于估计多载体中每两个载体之间的最优相对位置与相对速度,其特征在于,每个载体对应一个依次连接的GNSS/INS超紧组合导航装置、数据传输单元和数据处理单元;
其中,数据传输单元包括有线传输和无线传输;数据处理单元包括相互连接的动态模型构建单元和相对导航滤波器;
GNSS/INS超紧组合导航装置中惯性测量单元的测量信息、从滤波器状态向量中的载波测量信息和组合滤波器估计出的载体状态信息、载波相位经有线传输至该载体对应的动态模型构建单元中;同时组合滤波器估计出的载体状态信息和载波相位还经无线传输至其他载体的动态模型构建单元中;
每个载体对应的动态模型构建单元利用有线传输和无线传输获得的信息来确定动态模型的状态量和观测量后构建动态模型;根据动态模型,相对导航滤波器利用卡尔曼最优滤波递推方程组,计算得到误差状态的最优估计值,对两个载体的相对位置和相对速度进行补偿进而得到最优的相对位置和相对速度。
进一步地优选方案,本发明相对导航***中,动态模型的状态量和观测量如下:
动态模型的状态量为xGPS和xINS
xINS=[δΔv δΔx δwm δam]T;
式中,Δx为两个载体的相对位置,为双差整周模糊度,Δmφ单差载波相位多路径误差,δT为对流层误差;δI为电离层误差;δΔv为两个载体的相对速度误差状态,δΔx为两个载体的相对位置误差状态,δwm为载体m陀螺仪误差姿态向量;δam为载体m加速度误差状态向量,下标m为载体标号;
动态模型的的观测量为z=[Δv Δx]T,Δv为两个载体的相对速度;Δx为两个载体的相对位置。
本发明与现有技术相比具有以下显著的优点:
(1)本发明采用分布式滤波结构先利用从滤波器对每个卫星通道I,Q信号进行预处理,再将从滤波器预处理后的信息发送至组合滤波器,避免了集中式数据处理对数据处理速度要求很高,***复杂实现难度大的问题;
(2)基于GNSS/INS超紧组合相对导航***里,利用了GNSS/INS超紧组合导航方式,充分结合了两者的优势,将信息融合方式深入到跟踪环路I,Q信号的层次,加强GNSS接收机对卫星信号的捕获和跟踪能力,进而提高***的抗动态和抗干扰能力。同时避免了惯性测量误差随时间累计等问题;(3)本发明的GNSS/INS超紧组合导航装置的相对导航***通过无线传输将各载体的低速率数据(载波相位和载体导航信息)传输至载体的数据处理单元完成载体之间信息的共享,增强信息冗余度,进而提高估计精度。
附图说明
图1为本发明的GNSS/INS超紧组合导航装置原理图;
图2为本发明的基于GNSS/INS超紧组合导航装置的相对导航***原理图;
图3为本发明的数据处理单元的工作流程图;
下面结合附图和具体实施方式对本发明作进一步详细的描述;
具体实施方式
如图1所示,本发明一种GNSS/INS超紧组合导航装置,该装置基于分布式滤波结构来实现,包括GPS射频前端、惯性测量单元、跟踪捕获环路单元和组合滤波器;所述跟踪捕获环路单元包括N个可见卫星通道,每个可见卫星通道对应一个积分处理单元和从滤波器;GPS射频前端接收卫星信号,并进行功率放大、频率转换和数模转换,将转换后的数据发送至跟踪捕获环路单元,跟踪捕获环路单元中各可见卫星通道的I、Q信号经过对应的积分处理单元处理后发送至对应的从滤波器进行预处理得到从滤波器的状态向量;组合滤波器接收惯性测量单元的测量信息和从滤波器的状态向量,利用上述信息估计出该载体状态信息和载波相位并生成环路控制指令对跟踪捕获环路单元进行控制。
GNSS***提供的连续的位置、速度信息可以辅助INS***的初始对准,误差估计、补偿和校正等。同时,组合中GNSS***还将获得来时INS的辅助,进而有效地改善动态环境下GNSS接收机对卫星信号的捕获和跟踪能力,并能保证在卫星分布情况差或可见星数量少的情况下保持较高定位精度和可靠性。GNSS射频前端将采集到的卫星信号进行调理,变频并数字化。跟踪捕获环路负责信号的捕获和跟踪。GNSS/INS超紧组合滤波结构包括组合滤波器和从滤波器两部分。组合滤波器基于伪距,伪距率和载波相位层次,从滤波负责处理当前、超前和滞后的I,Q信号。组合滤波器完成对惯导信息和卫星信息的最优融合输出导航信息,同时向捕获跟踪环路发出环路控制指令。
从滤波器的处理流程:经过各通道后的I,Q信号经积分进入从滤波器,令各通道从滤波器的状态向量Xi=[δwi δφi δti Mi]T,其中δwi为载波频率估计误差,δφi是载波相位估计误差,δti为码相位估计误差,Mi为信号的载波幅度,i为从滤波器对应的可见卫星通道数,i=1,2,...N,N为可见卫星通道数,[]T表示矩阵转置;
从滤波器中观测量为积分周期T内当前I,Q信号值、超前I,Q信号值和滞后I,Q信号值,可表示为:
其中,T0为积分周期的起始时刻,T为积分周期,ε是接收机产生伪随机码的超前与滞后量之间的时间偏移;
因此,分布式滤波结构中从滤波器的状态和量测方程为:
其中,Xi为状态量,Zi为观测量,Ai(k,k-1)表示从k-1时刻到k时刻的状态转移距阵;Wi(k-1)为k-1时刻的动态噪声,Ci(k)表示k时刻观测系数矩阵,Vi(k)为k时刻的观测噪声,k为离散化处理后的时间量,式中Wi(k-1)、Ai(k,k-1)、Vi(k)、Ci(k)的具体设计过程均为现有技术,具体参见文献:刘基余.GPS卫星导航定位原理与方法[M].北京:科学出版社.2003.
组合滤波器的处理流程:组合滤波器的状态向量在惯导状态量得基础上增加了从滤波器的的误差状态估计,即:
其中,δx,δv和分别为位置,速度和姿态误差状态,δw为陀螺仪误差姿态向量,δa为加速度误差状态向量;δtu为接收机的时钟偏差,δtr是接收机的时钟随机漂移误差量。
由伪距误差和伪距率误差组成的量测向量为:
其中,δρi和分别是GNSS和INS输出的伪距之差和伪距率之差,下标N为可见卫星通道数。
组合滤波器的状态和观测方程可表示为:
其中,X为状态量,Z为观测量,W(k-1)为k-1时刻的动态噪声,V(k)为k时刻的观测噪声,k为离散化处理后的时间量,C(k)表示k时刻观测系数矩阵,A(k,k-1)表示从k-1时刻到k时刻的状态转移距阵,W(k-1)、V(k)、C(k)、A(k,k-1)的具体设计过程为现有技术,具体参见文献:刘基余.GPS卫星导航定位原理与方法[M].北京:科学出版社.2003.
如图2所示,基于GNSS/INS超紧组合导航装置的相对导航***,包括载体1和载体2,载体1对应GNSS射频前端11、惯性测量单元12、跟踪捕获环路单元13、组合滤波器14、数据传输单元15和数据处理单元16;其中,组合滤波器14分别与跟踪捕获环路单元13、惯性测量单元12、数据传输单元15相连,跟踪捕获环路单元13还与GNSS射频前端11相连,数据传输单元15还与数据处理单元16相连;数据传输单元15包括有线传输151和无线传输152;数据处理单元16包括相连的模型构建单元161和相对导航滤波器162;
载体2对应GNSS射频前端21、惯性测量单元22、跟踪捕获环路单元23、组合滤波器24、数据传输单元25和数据处理单元26;其中,组合滤波器24分别与跟踪捕获环路单元23、惯性测量单元22、数据传输单元25相连,跟踪捕获环路单元23还与GNSS射频前端21相连,数据传输单元25还与数据处理单元26相连;数据传输单元25包括有线传输251和无线传输252;数据处理单元26包括相连的模型构建单元261和相对导航滤波器262;
GNSS射频前端11接收并处理卫星信号数据后将数据发送至跟踪捕获环路单元,跟踪捕获环路单元13中各可见卫星通道的I、Q信号经过对应的积分处理单元处理后发送至对应的从滤波器进行预处理得到从滤波器的状态向量;
组合滤波器14接收惯性测量单元的测量信息:加速度a1、角速度ω1和从滤波器的状态向量,利用上述信息估计出载体1的位置x1、速度v1、姿态和载波相位φ1并生成环路控制指令对跟踪捕获环路单元13进行控制;
GNSS射频前端21接收并处理卫星信号数据后将数据发送至跟踪捕获环路单元,跟踪捕获环路单元23中各可见卫星通道的I、Q信号经过对应的积分处理单元处理后发送至对应的从滤波器进行预处理得到从滤波器的状态向量;
组合滤波器24接收惯性测量单元的测量信息:加速度a2、角速度ω2和从滤波器的状态向量,利用上述信息估计出载体2的位置x2、速度v2、姿态和载波相位φ2并生成环路控制指令对跟踪捕获环路单元23进行控制;
惯性测量单元11的测量信息、从滤波器的状态向量中的载波测量信息和组合滤波器14估计出的载体1状态信息和载波相位φ1经有线传输151至载体1量测模块构建单元161中;同时组合滤波器14还将估计出载体1的位置x1、速度v1和载波相位φ1经无线传输152至载体2量测模块构建单元262中;惯性测量单元12的测量信息、从滤波器的状态向量中的载波测量信息和组合滤波器估计出的载体2状态信息和载波相位φ2经有线传输251至载体2量测模块构建单元261中;同时组合滤波器24还将估计出载体2的位置x2、速度v2、载波相位φ2经无线传输252至载体1量测模块构建单元162中,
量测模块构建单元161根据通过测量信息、从滤波器的状态向量中的载波测量信息、载体1状态信息、载波相位φ1、载体2状态信息和载波相位φ2来确定动态模型的状态量和观测量后构建动态模型,
相对导航滤波器162利用卡尔曼最优滤波递推方程组,计算得到误差状态的最优估计值,对两个载体的相对位置和相对速度进行补偿进而得到最优的载体1相对载体2的位置和速度;
量测模块构建单元261根据通过测量信息、从滤波器的状态向量中的载波测量信息、载体2状态信息、载波相位φ2、载体1状态信息和载波相位φ1来确定动态模型的状态量和观测量后构建动态模型,
相对导航滤波器262利用卡尔曼最优滤波递推方程组,计算得到误差状态的最优估计值,对两个载体的相对位置和相对速度进行补偿进而得到最优的载体2相对载体1的位置和速度。
如图3所示,数据处理中心的目的是对相对导航进行误差估计并完成相对导航最优输出。将载体上的位置和速度状态估计通过低速率数据链传送至各载体的数据处理单元,以各载***置和速度状态作差之后的相对导航信息作为标称值。目标载体的数据处理单元利用GNSS双差载波相位和自身载体上的惯性信息,对相对导航误差状态进行最优估计,并完成相对导航状态的最优估计;
具体地利用双差载波相位完成对相对位置估计,利用加速度测量和相对位置完成对相对速度的估计。
以下以载体1与载体2为例:双差载波相位是通过两次差分得:先将载体1和载体2的载波测量进行一次差,这个过程消除了卫星时钟误差和星历误差;再将第一次差分量相对主卫星的一次差分量进行再次差分,再次消除了接收机时钟误差,双差载波相位可表示为:
其中,Δx=x1-x2,x1和x2分别表示载体1和载体2在地心地固坐标系(ECEF)下的位置向量;λ为载波波长;为卫星i的系数矩阵,为卫星j的系数矩阵;δTi,j和δIi,j分别为卫星i和卫星j的对流层残差和电离层残差;是卫星i和卫星j的双差整周模糊度;为卫星i的单差载波相位多路径误差;为卫星j的单差载波相位多路径误差;为卫星i和卫星j的双差载波相位测量噪声,卫星i和卫星j是指载体1对应的卫星i、载体2对应的卫星j;这里的卫星i对应通道数i,卫星j对应通道数j;
因此,GNSS估计相对位置的状态向量可表示为:
式中,为双差整周模糊度,Δmφ单差载波相位多路径误差,δT为对流层误差;δI为电离层误差。
线性化后的动态模型可表示为一般形式:
δxGPS为GNSS的相对位置误差状态量,wG为状态误差,ΦG为系数矩阵。
令v1和v2分别为载体1和载体2的相对地球的速度向量,则
v1=v2+Δv+wen×Δx (9)
根据比力方程可知:
a1=a2+Δa+2wen×Δv+wen×Δx+wen×(wen×Δx) (10)
a1=f1-2wie×v1+g1 (11)
a2=f2-2wie×v2+g2 (12)
其中,下标1,2分别代表载体1和载体2,Δv为两个载体的相对速度,Δx为两个载体的相对位置,a1为载体1相对地球的加速度向量,a2为载体2相对地球的加速度向量;f1为载体1在导航坐标系下比力输出;f2为载体2在导航系下比力输出;g1为载体1所受的重力向量,g2为载体2所受的重力向量,wen为导航坐标系相对地理系的角速度;wie为地理系相对惯性系的角速度,
将式(9),(11)和(12)代入(10)可得,
将式(12)进行泰勒级数展开即可得到相对位置和相对速度的状态,其动态模型的状态量xINS为
xINS=[δΔv δΔx δw1δa1]T (13)
δΔv为两个载体的相对速度误差状态,δΔx为两个载体的相对位置误差状态,δw1为载体1的陀螺仪误差姿态向量;δa1为载体1加速度误差状态向量;
线性化后的动态模型可表示为
其中,δxINS为INS的相对速度和位置误差状态量,wINS为状态误差,ΦI为对应的系数矩阵。
式(8)和(14)构成相对导航滤波器的状态方程,
观测向量z=[Δv Δx]T,相对导航滤波器的动态模型可表示为:
其中M(k)为k时刻标称轨迹,Φ(k,k-1)表示从k-1时刻到k时刻的状态转移阵;C(k)表示k时刻的观测系数矩阵;v(k)为观测矩阵,w(k-1)为动态噪声,x表示状态量,z表示观测量。这里的Φ(k,k-1)、C(k)、v(k)、w(k-1)的具体设计过程参照刘基余.GPS卫星导航定位原理与方法[M].北京:科学出版社.2003.
根据公式(15)利用卡尔曼最优滤波递推方程组,进行相对位置和相对速度的误差估计,进而得出最优的相对导航信息;
Pk,k-1=Φk,k-1Pk-1Φk,k-1+Qk-1
由上述递推方程组,计算得到误差状态的最优估计后,对两个载体的相对位置和相对速度进行补偿进而得到最优的相对位置和相对速度,关于卡尔曼最优滤波递推方程组为现有技术,参见俞济祥,主编《卡尔曼滤波及其在惯性导航中的应用》,航空专业教材编审组,1984年。
Claims (4)
1.一种GNSS/INS超紧组合导航装置,其特征在于,该装置基于分布式滤波结构来实现,包括GNSS射频前端、惯性测量单元、跟踪捕获环路单元和组合滤波器;组合滤波器分别与惯性测量单元、跟踪捕获环路单元相连,跟踪捕获环路单元还与GNSS射频前端相连;
其中,跟踪捕获环路单元包括若干个可见卫星通道,每个可见卫星通道对应一个积分处理单元和从滤波器;GNSS射频前端接收并处理卫星信号数据后将数据发送至跟踪捕获环路单元,跟踪捕获环路单元中各可见卫星通道的I、Q信号经过对应的积分处理单元处理后发送至对应的从滤波器进行预处理得到从滤波器的状态向量;组合滤波器接收惯性测量单元的测量信息和从滤波器的状态向量,利用接收到的信息估计出载体状态信息和载波相位并生成环路控制指令对跟踪捕获环路单元进行控制,其中所述载体状态信息包括位置、速度和姿态,从滤波器处理当前、超前和滞后的I,Q信号;
从滤波器的状态向量Xi=[δwi δφi δti Mi]T,其中δwi为载波频率估计误差,δφi是载波相位估计误差,δti为码相位估计误差,Mi为信号的载波幅度,i为从滤波器对应的可见卫星通道数,i=1,2,...N,N为可见卫星通道数,[]T表示矩阵转置;
从滤波器中观测量Zi为积分周期T内当前I,Q信号值、超前I,Q信号值和滞后I,Q信号值,表示为:
其中,T0为积分周期的起始时刻,ε是接收机产生伪随机码的超前与滞后量之间的时间偏移。
2.根据权利要求1所述GNSS/INS超紧组合导航装置,其特征在于,组合滤波器的状态向量
其中,δx为位置误差状态,δv为速度误差状态,为姿态误差状态,δw为陀螺仪误差姿态向量,δa为加速度误差状态向量;δtu为接收机的时钟偏差,δtr是接收机的时钟随机漂移误差量;
组合滤波器的量测向量Z为:
其中,δρi表示GNSS和INS输出的伪距之差,表示GNSS和INS输出伪距率之差。
3.一种基于权利要求2所述GNSS/INS超紧组合导航装置的相对导航***,该***用于估计多载体中每两个载体之间的最优相对位置与相对速度,其特征在于,每个载体对应一个依次连接的GNSS/INS超紧组合导航装置、数据传输单元和数据处理单元;
其中,数据传输单元包括有线传输和无线传输;数据处理单元包括相互连接的动态模型构建单元和相对导航滤波器;
GNSS/INS超紧组合导航装置中惯性测量单元的测量信息、从滤波器状态向量中的载波测量信息和组合滤波器估计出的载体状态信息、载波相位经有线传输至该载体对应的动态模型构建单元中;同时组合滤波器估计出的载体状态信息和载波相位还经无线传输至其他载体的动态模型构建单元中;
每个载体对应的动态模型构建单元利用有线传输和无线传输获得的信息来确定动态模型的状态量和观测量后构建动态模型;根据动态模型,相对导航滤波器利用卡尔曼最优滤波递推方程组,计算得到误差状态的最优估计值,对两个载体的相对位置和相对速度进行补偿进而得到最优的相对位置和相对速度。
4.根据权利要求3所述的相对导航***,其特征在于,动态模型的状态量和观测量如下:
动态模型的状态量为xGPS和xINS
xINS=[δΔv δΔx δwm δam]T;
式中,Δx为两个载体的相对位置,为双差整周模糊度,Δmφ单差载波相位多路径误差,δT为对流层误差;δI为电离层误差;δΔv为两个载体的相对速度误差状态,δΔx为两个载体的相对位置误差状态,δwm为载体m陀螺仪误差姿态向量;δam为载体m加速度误差状态向量,下标m为载体标号;
动态模型的观测量为z=[Δv Δx]T,Δv为两个载体的相对速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410426136.9A CN104316947B (zh) | 2014-08-26 | 2014-08-26 | Gnss/ins超紧组合导航装置及相对导航*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410426136.9A CN104316947B (zh) | 2014-08-26 | 2014-08-26 | Gnss/ins超紧组合导航装置及相对导航*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104316947A CN104316947A (zh) | 2015-01-28 |
CN104316947B true CN104316947B (zh) | 2017-04-12 |
Family
ID=52372200
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410426136.9A Expired - Fee Related CN104316947B (zh) | 2014-08-26 | 2014-08-26 | Gnss/ins超紧组合导航装置及相对导航*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104316947B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104931994A (zh) * | 2015-06-12 | 2015-09-23 | 南京理工大学 | 一种基于软件接收机的分布式深组合导航方法及*** |
US10094930B2 (en) * | 2015-06-23 | 2018-10-09 | Honeywell International Inc. | Global navigation satellite system (GNSS) spoofing detection with carrier phase and inertial sensors |
CN105068102A (zh) * | 2015-08-11 | 2015-11-18 | 南京理工大学 | 一种基于dsp+fpga的超紧组合导航方法 |
CN105445771A (zh) * | 2015-11-13 | 2016-03-30 | 上海华测导航技术股份有限公司 | 一种单频rtk融合测试分析方法 |
CN105954783B (zh) * | 2016-04-26 | 2017-03-29 | 武汉大学 | 一种改进gnss/ins实时紧组合导航实时性能的方法 |
CN106154300B (zh) * | 2016-06-22 | 2018-09-14 | 南京航空航天大学 | 一种惯性/卫星超紧组合实现方法 |
CN106595656B (zh) * | 2016-12-29 | 2019-09-10 | 辽宁工程技术大学 | 一种基于车载pos的公路线形特征识别与参数计算方法 |
CN107478220B (zh) * | 2017-07-26 | 2021-01-15 | 中国科学院深圳先进技术研究院 | 无人机室内导航方法、装置、无人机及存储介质 |
CN107917708A (zh) * | 2017-11-10 | 2018-04-17 | 太原理工大学 | 基于贝叶斯压缩感知的gps/ins紧组合周跳探测和修复算法 |
CN109991640B (zh) * | 2017-12-29 | 2022-04-01 | 上海司南卫星导航技术股份有限公司 | 一种组合导航***及其定位方法 |
CN109725339A (zh) * | 2018-12-20 | 2019-05-07 | 东莞市普灵思智能电子有限公司 | 一种紧耦合的自动驾驶感知方法及*** |
CN111190208A (zh) * | 2020-01-14 | 2020-05-22 | 成都纵横融合科技有限公司 | 一种基于rtk的gnss/ins紧组合导航解算方法 |
CN112269201B (zh) * | 2020-10-23 | 2024-04-16 | 北京云恒科技研究院有限公司 | 一种gnss/ins紧耦合时间分散滤波方法 |
CN112649820B (zh) * | 2020-11-04 | 2022-09-16 | 深圳市三七智联科技有限公司 | 射频前端芯片的信号接收方法、卫星定位***及存储介质 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101666868B (zh) * | 2009-09-30 | 2011-11-16 | 北京航空航天大学 | 一种基于sins/gps深组合数据融合的卫星信号矢量跟踪方法 |
CN101666650B (zh) * | 2009-09-30 | 2011-04-06 | 北京航空航天大学 | 一种sins/gps超紧致组合导航***及实现方法 |
CN103995272B (zh) * | 2014-06-11 | 2017-02-15 | 东南大学 | 一种惯性辅助gps接收机实现方法 |
-
2014
- 2014-08-26 CN CN201410426136.9A patent/CN104316947B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN104316947A (zh) | 2015-01-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104316947B (zh) | Gnss/ins超紧组合导航装置及相对导航*** | |
CN201266089Y (zh) | Ins/gps组合导航*** | |
Han et al. | Integrated GPS/INS navigation system with dual-rate Kalman Filter | |
CN102508277A (zh) | 精密单点定位与惯性测量紧组合导航***及数据处理方法 | |
CN107656300B (zh) | 基于北斗/gps双模软件接收机的卫星/惯性超紧组合方法 | |
CN102608642A (zh) | 北斗/惯性组合导航*** | |
CN108226985A (zh) | 基于精密单点定位的列车组合导航方法 | |
CN106255065A (zh) | 智能手机和移动终端室内外无缝定位***及其方法 | |
CN102853837B (zh) | 一种mimu和gnss信息融合的方法 | |
Zhao | GPS/IMU integrated system for land vehicle navigation based on MEMS | |
CN103900565A (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN103868514A (zh) | 一种在轨飞行器自主导航*** | |
Sun et al. | Precise vehicle dynamic heading and pitch angle estimation using time-differenced measurements from a single GNSS antenna | |
CN106405592B (zh) | 车载北斗载波相位周跳检测与修复方法及*** | |
CN103454665A (zh) | 一种双差gps/sins组合导航姿态测量方法 | |
CN106802153B (zh) | 基于单频导航原始观测量地面处理的高精度测定轨方法 | |
CN102253396A (zh) | 一种高动态gps载波环跟踪方法 | |
CN104931994A (zh) | 一种基于软件接收机的分布式深组合导航方法及*** | |
CN103697892B (zh) | 一种多无人艇协同导航条件下陀螺漂移的滤波方法 | |
CN106199668A (zh) | 一种级联式gnss/sins深组合导航方法 | |
CN202305821U (zh) | 精密单点定位与惯性测量紧组合导航*** | |
CN103575297B (zh) | 基于卫星导航接收机的gnss和mimu组合导航航向角估计方法 | |
Tsujii et al. | Development of INS-aided GPS tracking loop and flight test evaluation | |
CN105988129A (zh) | 一种基于标量估计算法的ins/gnss组合导航方法 | |
Han et al. | Land vehicle navigation with the integration of GPS and reduced INS: performance improvement with velocity aiding |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170412 Termination date: 20200826 |
|
CF01 | Termination of patent right due to non-payment of annual fee |