CN113203414B - 一种基于gps+bds ppp/imu紧组合的列车定位方法 - Google Patents
一种基于gps+bds ppp/imu紧组合的列车定位方法 Download PDFInfo
- Publication number
- CN113203414B CN113203414B CN202110557425.2A CN202110557425A CN113203414B CN 113203414 B CN113203414 B CN 113203414B CN 202110557425 A CN202110557425 A CN 202110557425A CN 113203414 B CN113203414 B CN 113203414B
- Authority
- CN
- China
- Prior art keywords
- satellite
- train
- representing
- error
- bds
- 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 43
- 238000005259 measurement Methods 0.000 claims abstract description 31
- 238000012937 correction Methods 0.000 claims abstract description 13
- 230000008569 process Effects 0.000 claims abstract description 12
- 238000001914 filtration Methods 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 15
- 239000005433 ionosphere Substances 0.000 claims description 12
- 230000008859 change Effects 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 7
- 230000008520 organization Effects 0.000 claims description 5
- 239000005436 troposphere Substances 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 230000008030 elimination Effects 0.000 claims description 2
- 238000003379 elimination reaction Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 4
- 238000010276 construction Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 230000001419 dependent effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000006467 substitution reaction Methods 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/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/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/33—Multimode operation in different systems which transmit time stamped messages, e.g. GPS/GLONASS
-
- 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/50—Determining position whereby the position solution is constrained to lie upon a particular curve or surface, e.g. for locomotives on railway tracks
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
本发明提供了一种基于GPS+BDS PPP/IMU紧组合的列车定位方法。该方法包括:从列车接收机获取卫星原始观测数据,从IGS获取卫星轨道数据;根据精密单点定位误差模型对卫星观测数据和卫星轨道数据进行误差校正;构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型将误差校正后的卫星观测数据作为量测,通过非线性卡尔曼滤波器求解所述GPS+BDS PPP/IMU紧组合模型,滤波估计解算列车的位置信息。本发明通过对列车行驶过程中卫星原始观测数据和惯性传感器输出数据的采集,由多星座条件下精密单点定位/惯性导航紧组合系统解算获取列车运行位置信息,具有无需轨旁设备、数据输出频率高、定位结果精度较高的特点。
Description
技术领域
本发明涉及列车定位技术领域,尤其涉及一种基于GPS+BDS PPP/IMU紧组合的列车定位方法。
背景技术
卫星导航定位是列车定位的主要研究方向之一,卫星定位具有全天候、全球性等优点,但是容易受地面周边环境的干扰,而列车运行周边环境复杂,途径隧道、桥梁、山谷等地都会影响卫星定位的质量,甚至无法获得定位结果。
因此,惯性传感器和卫星导航联合定位能有效改善上述情况。惯性传感器有不依赖外部环境、独立自主的特点,结合惯性传感器和卫星定位技术既能有效消除惯性传感器定位的累计误差,又能改善定位结果的连续性,减小周边环境对定位结果的影响。IMU(Inertial Measurement Unit,惯性测量单元)/GNSS(Global Navigation SatelliteSystem,全球导航卫星系统)组合导航的组合方式可以分为松组合、紧组合和深组合三种。松组合是直接将位置信息和速度信息作为量测信息的组合方式,紧组合是将伪距、载波相位等接收机原始信息作为测量值的组合方式。相对于松组合,紧组合所使用的观测值精度更高,并且受可观测卫星数量的影响较小,在可见卫星颗数小于四的情况下,仍然能输出组合定位的结果,增强列车定位的连续性。
IMU/GNSS组合导航的系统精度主要依赖于GNSS,差分全球定位系统(Differential Global Navigation Satellite System,DGNSS)能够提供高精度的定位结果,但是需要有大量参考基站参与工作。精密单点定位是采用国际GNSS服务组织免费公开提供的精密星历和钟差,对信号从卫星至接收机遇到的各种误差进行模型搭建与校正,利用载波相位观测值实现单机绝对定位的方法。比起传统差分定位,精密单点定位只需一台双频接收机便可完成定位工作,能节约铁路建设维护成本,并且采用超快速星历,还能实现实时精密单点定位(Precise Point Positioning,PPP)。
此外,随着我国北斗卫星导航系统的建设完善,联合北斗和GPS一起定位能增加定位系统的自主性,同时,多卫星联合定位还能增加卫星颗数,改善卫星几何构型,增强卫星信号困难区域环境下的定位性能,获取更加稳定连续的定位结果。
目前,现有技术中还没有一种有效的基于GPS+BDS PPP/IMU紧组合的列车定位方法。
发明内容
本发明的实施例提供了一种基于GPS+BDS PPP/IMU紧组合的列车定位方法,以实现有效地对列车进行定位。
为了实现上述目的,本发明采取了如下技术方案。
一种基于GPS+BDS PPP/IMU紧组合的列车定位方法,包括:
在列车运行过程中,从列车接收机获取卫星原始观测数据,从国际GNSS服务组织IGS获取卫星轨道数据;
根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正;
构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型将误差校正后的卫星观测数据作为量测,通过非线性卡尔曼滤波器求解所述GPS+BDS PPP/IMU紧组合模型,滤波估计解算列车的位置信息。
优选地,所述的在列车运行过程中,从列车接收机获取卫星原始观测数据,从国际GNSS服务组织IGS获取卫星轨道数据,包括:
在列车运行过程中,从列车接收机获取卫星原始观测数据,所述卫星原始观测数据包括伪距、载波相位和伪距率;
从IGS获取卫星轨道数据,所述高精度卫星轨道数据包括IGS发布的实时精密星历,对实时精密星历中的数据进行卫星轨道和卫星钟差插值计算处理,得到所需频率的卫星位置和钟差。
优选地,所述的根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正,包括:
运用双频消除电离层组合模型减少所述卫星观测数据的电离层延迟,采用Saastamoinen模型校正所述卫星观测数据的对流层干延迟分量,用运动学公式修正所述卫星观测数据中地球自转效应带来的位置偏移,使用IGS提供的ANTEX格式文件对卫星天线质心位置进行校正。
优选地,所述的根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正,包括:
列车运行过程中,卫星信号的载波相位和伪距率观测方程如下所示:
其中:s表示GPS或者BDS卫星,φi表示卫星i的载波相位观测值,Di表示卫星i的伪距率观测值,ρi表示卫星i到列车接收机的几何距离,表示列车实际运行过程中电离层延迟,/>表示列车实际运行过程中对流层延迟,c表示光速,dtr表示接收机的时钟误差,dtS,i表示卫星i的时钟误差,Ni表示卫星i的模糊度,λ表示载波相位的波长,/>表示残差;
在以上观测方程基础上,使用消电离层组合消除电离层延迟,则观测方程改写为:
其中:f1、f2为GNSS信号频率,λ1、λ2分别为频率f1、f2信号的波长,和/>分别为消去电离层延迟之后的载波相位和伪距率观测值,/>和/> 分别为频率f1、f2信号的载波相位观测值和伪距率观测值,/>表示卫星i消除电离层延迟的模糊度;
将消除电离层组合的观测值相减,消除接收机钟差;
将高度角最优的卫星m选为参考卫星,那么卫星i相对于卫星m观测值的单差为:
优选地,所述的构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型将误差校正后的卫星观测数据作为量测,通过非线性卡尔曼滤波器求解所述GPS+BDS PPP/IMU紧组合模型,滤波估计解算列车的位置信息,包括:
构建GPS+BDS PPP/IMU紧组合模型,将IMU输出的结果转化为伪距和伪距率,与接收机获取的伪距和伪距率做差得到卡尔曼滤波中的测量值;
惯导递推更新包括姿态、速度和位置三个方面的更新:
其中,b指载体坐标系,n指导航坐标系,和/>指姿态四元数和其变化率,vn和/>分别是速度和速度变化率,pn和/>分别是位置和位置变化率,/>是角速度的斜对称矩阵,fn是加速度计测量值,gn是当地重力加速度,/>和/>分别是相对于惯性坐标系和地心地固坐标系的角速度;
实时非线性卡尔曼滤波器的状态向量、系统的测量矩阵、系统的测量值、测量噪声协方差,如下所示:
状态向量包含列车状态信息,惯导器件误差和无法模型化校正的未知参数,表示为:
其中,δp表示三维位置误差,δv表示三维速度误差,表示三维姿态误差,ε表示加速度计器件误差,▽表示陀螺仪器件误差,l表示IMU和GNSS之间的杆臂,ΔNIF表示消除电离层误差后的载波相位模糊度差,α和β分别是当前历元GPS和BDS的参考卫星,p和q分别是当前历元GPS和BDS除参考卫星外的可观测卫星总数,Δdwet表示对流层湿分量。
测量矩阵为:
其中,(xs,ys,zs)和(xr,yr,zr)分别为卫星和接收机的三维坐标。
测量值为星间单差消除电离层后的载波相位和伪距率之差:
其中,vs是卫星速度,vI是惯导递推得到的速度。
因为量测中对载波相位和伪距率都进行了星间单差的操作,所以测量噪声协方差矩阵写为:
根据非线性卡尔曼滤波器解算出的列车状态信息反馈校正惯性传感器的输出结果,获取实时的列车位置信息。
由上述本发明的实施例提供的技术方案可以看出,本发明实施例通过对列车行驶过程中卫星原始观测数据和惯性传感器输出数据的采集,以及对超快速高精度轨道产品的数据处理分析,由多星座条件下精密单点定位/惯性导航紧组合系统解算获取列车运行位置信息,具有无需轨旁设备、数据输出频率高、定位结果精度较高的特点。
本发明附加的方面和优点将在下面的描述中部分给出,这些将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种基于GPS+BDS PPP/IMU紧组合的列车定位方法的实现原理图;
图2为本发明实施例提供的一种基于GPS+BDS PPP/IMU紧组合的列车定位方法的处理流程图。
具体实施方式
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。
本技术领域技术人员可以理解,除非特意声明,这里使用的单数形式“一”、“一个”、“所述”和“该”也可包括复数形式。应该进一步理解的是,本发明的说明书中使用的措辞“包括”是指存在所述特征、整数、步骤、操作、元件和/或组件,但是并不排除存在或添加一个或多个其他特征、整数、步骤、操作、元件、组件和/或它们的组。应该理解,当我们称元件被“连接”或“耦接”到另一元件时,它可以直接连接或耦接到其他元件,或者也可以存在中间元件。此外,这里使用的“连接”或“耦接”可以包括无线连接或耦接。这里使用的措辞“和/或”包括一个或更多个相关联的列出项的任一单元和全部组合。
本技术领域技术人员可以理解,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
为便于对本发明实施例的理解,下面将结合附图以几个具体实施例为例做进一步的解释说明,且各个实施例并不构成对本发明实施例的限定。
为了减少列车定位对轨旁设施的依赖,减少铁路建设维护成本,本发明实施例提出一种基于GPS+BDS PPP/IMU紧组合的列车定位方法,保障列车定位精度,提升定位结果连续性、稳定性和可信度。
本发明实施例提供了一种基于GPS+BDS PPP/IMU紧组合的列车定位方法的实现原理图如图1所示,该方法的具体处理流程如图2所示,包括如下的处理步骤:
步骤S210:在列车运行过程中,从列车接收机获取卫星原始观测数据,上述卫星原始观测数据包括伪距、载波相位、伪距率等。
同时,为了保证系统定位的实时性,从国际GNSS服务组织(International GNSSServices,IGS)获取高精度卫星轨道数据,上述高精度卫星轨道数据包括IGS发布的实时精密星历,对实时精密星历中的数据进行卫星轨道和卫星钟差插值计算处理,得到所需频率的高精度卫星位置和钟差。
步骤S220:根据精密单点定位误差模型对卫星观测数据和卫星轨道数据进行误差校正。
运用消电离层组合(Ionosphere-Free Combination,IF)近似消除所述卫星观测数据的电离层延迟,采用Saastamoinen模型校正所述卫星观测数据的对流层干延迟分量,用运动学公式修正所述卫星观测数据中地球自转效应带来的位置偏移,使用IGS提供的ANTEX格式文件对卫星天线质心位置进行校正。
进一步地,列车运行过程中,卫星信号的载波相位和伪距率观测方程可以如下所示:
其中:s表示GPS或者BDS卫星,φi表示卫星i的载波相位观测值,Di表示卫星i的伪距率观测值,ρi表示卫星i到列车接收机的几何距离,表示列车实际运行过程中电离层延迟,/>表示列车实际运行过程中对流层延迟,c表示光速,dtr表示接收机的时钟误差,dtS,i表示卫星i的时钟误差,Ni表示卫星i的模糊度,λ表示载波相位的波长,/>表示残差。
在以上观测方程基础上,使用消电离层组合近似消除电离层延迟,则观测方程可以改写为:
其中:f1、f2为GNSS信号频率,λ1、λ2分别为频率f1、f2信号的波长,和/>分别为消去电离层延迟之后的载波相位和伪距率观测值,/>和/> 分别为频率f1、f2信号的载波相位观测值和伪距率观测值,/>表示卫星i消除电离层延迟的模糊度。
将消除电离层组合的观测值相减,可消除接收机钟差,减少误差参数,将高度角最优的卫星m选为参考卫星,那么卫星i相对于卫星m观测值的单差为:
步骤S230:构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型将误差校正后的卫星观测数据作为量测,通过非线性卡尔曼滤波器求解所述GPS+BDS PPP/IMU紧组合模型,滤波估计解算列车的位置信息。
本发明实施例的列车定位方法采用紧组合方式,系统需要将IMU输出的结果转化为伪距和伪距率,与接收机获取的伪距和伪距率做差得到卡尔曼滤波中的测量值,因采用的载波相位和伪距率是接收机的原始信息,结果会具有更好的连续性和稳定性,并且在卫星颗数小于三的情况下仍然能够输出定位结果。
惯导递推更新包括姿态、速度和位置三个方面的更新:
其中,b指载体坐标系,n指导航坐标系,和/>指姿态四元数和其变化率,vn和/>分别是速度和速度变化率,pn和/>分别是位置和位置变化率,/>是角速度的斜对称矩阵,fn是加速度计测量值,gn是当地重力加速度,/>和/>分别是相对于惯性坐标系和地心地固坐标系的角速度。
实时非线性卡尔曼滤波器的状态向量、系统的测量矩阵、系统的测量值、测量噪声协方差,如下所示:
状态向量包含列车状态信息,惯导器件误差和无法模型化校正的未知参数,表示为:
其中,δp表示三维位置误差,δv表示三维速度误差,表示三维姿态误差,ε表示加速度计器件误差,▽表示陀螺仪器件误差,l表示IMU和GNSS之间的杆臂,ΔNIF表示消除电离层误差后的载波相位模糊度差,α和β分别是当前历元GPS和BDS的参考卫星,p和q分别是当前历元GPS和BDS除参考卫星外的可观测卫星总数,Δdwet表示对流层湿分量。
测量矩阵为:
其中,(xs,ys,zs)和(xr,yr,zr)分别为卫星和接收机的三维坐标。
测量值为星间单差消除电离层后的载波相位和伪距率之差:
其中,vs是卫星速度,vI是惯导递推得到的速度。
因为量测中对载波相位和伪距率都进行了星间单差的操作,所以测量噪声协方差矩阵写为:
根据非线性卡尔曼滤波器解算出的列车状态信息反馈校正惯性传感器的输出结果,获取实时的列车位置信息。
根据上述各模型并通过本发明方法可以得出以下实验结果:
在列车运行的过程中,实时记录安装在列车上的GNSS接收机的卫星观测数据信息和惯性传感器输出数据信息,结合IGS发布的实时超快速精密星历,通过多星座条件下精密单点定位/惯性系统紧组合导航方法解算获取列车运行位置信息,具有无需轨旁设备、数据输出频率高、定位结果精度较高的特点。
综上所述,本发明实施例通过首先从列车接收机和国际GNSS服务组织分别获取卫星原始观测数据,如载波相位和伪距率,和高精度卫星轨道产品,然后根据精密单点定位误差模型对卫星观测数据和卫星轨道数据进行误差校正,最后构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型校正后的原始观测值作为量测,提升量测精度,在可见卫星颗数小于四的情况下输出定位结果,同时,结合惯性传感器提升定位结果数据更新率,增强定位短时精度和连续性。此外,在多星座条件下定位还能增加卫星数目、改善卫星几何分布,增强定位系统的自主性和适应性。
本发明实施例提供了一种基于GPS+BDS PPP/IMU紧组合的列车定位方法,通过对列车行驶过程中卫星原始观测数据和惯性传感器输出数据的采集,以及对超快速高精度轨道产品的数据处理分析,由多星座条件下精密单点定位/惯性导航紧组合系统解算获取列车运行位置信息,具有无需轨旁设备、数据输出频率高、定位结果精度较高的特点。
本领域普通技术人员可以理解:附图只是一个实施例的示意图,附图中的模块或流程并不一定是实施本发明所必须的。
通过以上的实施方式的描述可知,本领域的技术人员可以清楚地了解到本发明可借助软件加必需的通用硬件平台的方式来实现。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例或者实施例的某些部分所述的方法。
本说明书中的各个实施例均采用递进的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置或系统实施例而言,由于其基本相似于方法实施例,所以描述得比较简单,相关之处参见方法实施例的部分说明即可。以上所描述的装置及系统实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性劳动的情况下,即可以理解并实施。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求的保护范围为准。
Claims (3)
1.一种基于GPS+BDS PPP/IMU紧组合的列车定位方法,其特征在于,包括:
在列车运行过程中,从列车接收机获取卫星观测数据,从国际GNSS服务组织IGS获取卫星轨道数据;
根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正;
构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型将误差校正后的卫星观测数据作为量测,通过非线性卡尔曼滤波器求解所述GPS+BDS PPP/IMU紧组合模型,滤波估计解算列车的位置信息,具体包括:
构建GPS+BDS PPP/IMU紧组合模型,将IMU输出的结果转化为伪距和伪距率,与接收机获取的伪距和伪距率做差得到卡尔曼滤波中的测量值;
惯导递推更新包括姿态、速度和位置三个方面的更新:
其中,b指载体坐标系,n指导航坐标系,和/>指姿态四元数和其变化率,vn和/>分别是速度和速度变化率,pn和/>分别是位置和位置变化率,/>是角速度的斜对称矩阵,fn是加速度计测量值,gn是当地重力加速度,/>和/>分别是相对于惯性坐标系和地心地固坐标系的角速度;
实时非线性卡尔曼滤波器的状态向量、系统的测量矩阵、系统的测量值、测量噪声协方差,如下所示:
状态向量包含列车状态信息,惯导器件误差和无法模型化校正的未知参数,表示为:
其中,δp表示三维位置误差,δv表示三维速度误差,表示三维姿态误差,ε表示加速度计器件误差,/>表示陀螺仪器件误差,l表示IMU和GNSS之间的杆臂,ΔNIF表示消除电离层误差后的载波相位模糊度差,α和β分别是当前历元GPS和BDS的参考卫星,p和q分别是当前历元GPS和BDS除参考卫星外的可观测卫星总数,Δdwet表示对流层湿分量;
测量矩阵为:
其中,(xs,ys,zs)和(xr,yr,zr)分别为卫星和接收机的三维坐标;
测量值为星间单差消除电离层后的载波相位和伪距率之差:
其中,vs是卫星速度,vI是惯导递推得到的速度;
因为量测中对载波相位和伪距率都进行了星间单差的操作,所以测量噪声协方差矩阵写为:
所述的根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正,包括:
列车运行过程中,卫星信号的载波相位和伪距率观测方程如下所示:
其中:s表示GPS或者BDS卫星,φi表示卫星i的载波相位观测值,Di表示卫星i的伪距率观测值,ρi表示卫星i到列车接收机的几何距离,表示列车实际运行过程中电离层延迟,表示列车实际运行过程中对流层延迟,c表示光速,dtr表示接收机的时钟误差,dtS,i表示卫星i的时钟误差,Ni表示卫星i的模糊度,λ表示载波相位的波长,/>表示残差;
在以上观测方程基础上,使用消电离层组合消除电离层延迟,则观测方程改写为:
其中:f1、f2为GNSS信号频率,λ1、λ2分别为频率f1、f2信号的波长,和/>分别为消去电离层延迟之后的载波相位和伪距率观测值,/>和/> 分别为频率f1、f2信号的载波相位观测值和伪距率观测值,/>表示卫星i消除电离层延迟的模糊度;
将消除电离层组合的观测值相减,消除接收机钟差;
将高度角最优的卫星m选为参考卫星,那么卫星i相对于卫星m观测值的单差为:
2.根据权利要求1所述的方法,其特征在于,所述的在列车运行过程中,从列车接收机获取卫星观测数据,从国际GNSS服务组织IGS获取卫星轨道数据,包括:
在列车运行过程中,从列车接收机获取卫星观测数据,所述卫星观测数据包括伪距、载波相位和伪距率;
从IGS获取卫星轨道数据,所述卫星轨道数据包括IGS发布的实时精密星历,对实时精密星历中的数据进行卫星轨道和卫星钟差插值计算处理,得到所需频率的卫星位置和钟差。
3.根据权利要求2所述的方法,其特征在于,所述的根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正,包括:
运用双频消除电离层组合模型减少所述卫星观测数据的电离层延迟,采用Saastamoinen模型校正所述卫星观测数据的对流层干延迟分量,用运动学公式修正所述卫星观测数据中地球自转效应带来的位置偏移,使用IGS提供的ANTEX格式文件对卫星天线质心位置进行校正。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110557425.2A CN113203414B (zh) | 2021-05-21 | 2021-05-21 | 一种基于gps+bds ppp/imu紧组合的列车定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110557425.2A CN113203414B (zh) | 2021-05-21 | 2021-05-21 | 一种基于gps+bds ppp/imu紧组合的列车定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113203414A CN113203414A (zh) | 2021-08-03 |
CN113203414B true CN113203414B (zh) | 2023-06-13 |
Family
ID=77022828
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110557425.2A Active CN113203414B (zh) | 2021-05-21 | 2021-05-21 | 一种基于gps+bds ppp/imu紧组合的列车定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113203414B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113581260B (zh) * | 2021-09-01 | 2023-04-18 | 兰州交通大学 | 一种基于gnss的列车轨道占用判别方法 |
CN115902981B (zh) * | 2022-11-14 | 2024-01-30 | 中南大学 | 列车定位优化方法、系统及轨道交通车辆 |
CN117782080B (zh) * | 2024-02-23 | 2024-04-30 | 中国科学院空天信息创新研究院 | 基于PPP-B2b/INS的实时空基导航系统及方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107976697B (zh) * | 2017-11-30 | 2021-05-28 | 中国铁路总公司 | 一种基于北斗/gps组合的列车安全定位方法及系统 |
CN108226985B (zh) * | 2017-12-25 | 2020-01-07 | 北京交通大学 | 基于精密单点定位的列车组合导航方法 |
CN108519614A (zh) * | 2018-03-16 | 2018-09-11 | 东南大学 | 一种gps/bds紧组合载波差分定位方法 |
CN112629526B (zh) * | 2020-11-19 | 2023-10-31 | 中国人民解放军战略支援部队信息工程大学 | 一种北斗精密单点定位和惯性系统的紧组合导航方法 |
CN112147663B (zh) * | 2020-11-24 | 2021-02-09 | 中国人民解放军国防科技大学 | 一种卫星和惯性组合动对动实时精密相对定位方法 |
-
2021
- 2021-05-21 CN CN202110557425.2A patent/CN113203414B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113203414A (zh) | 2021-08-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113203414B (zh) | 一种基于gps+bds ppp/imu紧组合的列车定位方法 | |
CN108226985B (zh) | 基于精密单点定位的列车组合导航方法 | |
CN107710017A (zh) | 用于在实时运动模式和相对定位模式之间切换的卫星导航接收器及方法 | |
CN113203418B (zh) | 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及系统 | |
CN105607093A (zh) | 一种组合导航系统及获取导航坐标的方法 | |
CN111965685B (zh) | 一种基于多普勒信息的低轨卫星/惯性组合导航定位方法 | |
CN113204042B (zh) | 一种基于精密单点定位的多星座联合列车定位方法 | |
CN112731502B (zh) | 一种无人机空中加油惯性辅助北斗三频精密相对导航方法 | |
CN116299623B (zh) | 一种城市复杂场景下的ppp和ins紧组合方法与系统 | |
CN116540303B (zh) | 一种历元间差分观测方程建立方法和地震位移计算方法 | |
US20230280476A1 (en) | System and method for fusing sensor and satellite measurements for positioning determination | |
CN108205151B (zh) | 一种低成本gps单天线姿态测量方法 | |
CN116794695A (zh) | 基于双重优化的高程辅助低轨卫星机会信号定位方法 | |
US20230184956A1 (en) | System and method for correcting satellite observations | |
CN116299599A (zh) | 一种ins辅助的gnss伪距粗差探测方法 | |
CN115267858A (zh) | 一种区域导航系统辅助的精密单点定位方法 | |
CN115220078A (zh) | 基于载波相位差分的gnss高精度定位方法及导航方法 | |
CN115326067A (zh) | 基于低轨导航增强的ppp-ins组合导航定位方法及系统 | |
CN105510936A (zh) | 星载gnss联合定轨方法 | |
CN114063122A (zh) | 电推进转移轨道航天器星载gnss在轨实时定轨方法 | |
CN103389502B (zh) | 基于多个地面基站高精度确定载体加速度的方法 | |
Van Graas | Doppler processing for satellite navigation | |
CN117031521B (zh) | 一种室内外无缝环境下的弹性融合定位方法及系统 | |
CN111443369B (zh) | 一种高精度实时gnss多频快速收敛定位方法 | |
US20240077620A1 (en) | System and method for determining gnss corrections |
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 |