CN113203414B - 一种基于gps+bds ppp/imu紧组合的列车定位方法 - Google Patents

一种基于gps+bds ppp/imu紧组合的列车定位方法 Download PDF

Info

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
Application number
CN202110557425.2A
Other languages
English (en)
Other versions
CN113203414A (zh
Inventor
姜维
刘梦杨
蔡伯根
王剑
上官伟
刘江
陆德彪
柴琳果
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Jiaotong University
Original Assignee
Beijing Jiaotong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Jiaotong University filed Critical Beijing Jiaotong University
Priority to CN202110557425.2A priority Critical patent/CN113203414B/zh
Publication of CN113203414A publication Critical patent/CN113203414A/zh
Application granted granted Critical
Publication of CN113203414B publication Critical patent/CN113203414B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/33Multimode operation in different systems which transmit time stamped messages, e.g. GPS/GLONASS
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/42Determining position
    • G01S19/50Determining 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紧组合的列车定位方法
技术领域
本发明涉及列车定位技术领域,尤其涉及一种基于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格式文件对卫星天线质心位置进行校正。
优选地,所述的根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正,包括:
列车运行过程中,卫星信号的载波相位和伪距率观测方程如下所示:
Figure BDA0003077691990000031
Figure BDA0003077691990000032
其中:s表示GPS或者BDS卫星,φi表示卫星i的载波相位观测值,Di表示卫星i的伪距率观测值,ρi表示卫星i到列车接收机的几何距离,
Figure BDA0003077691990000033
表示列车实际运行过程中电离层延迟,/>
Figure BDA0003077691990000034
表示列车实际运行过程中对流层延迟,c表示光速,dtr表示接收机的时钟误差,dtS,i表示卫星i的时钟误差,Ni表示卫星i的模糊度,λ表示载波相位的波长,/>
Figure BDA0003077691990000035
表示残差;
在以上观测方程基础上,使用消电离层组合消除电离层延迟,则观测方程改写为:
Figure BDA0003077691990000041
Figure BDA0003077691990000042
其中:f1、f2为GNSS信号频率,λ1、λ2分别为频率f1、f2信号的波长,
Figure BDA0003077691990000043
和/>
Figure BDA0003077691990000044
分别为消去电离层延迟之后的载波相位和伪距率观测值,/>
Figure BDA0003077691990000045
和/>
Figure BDA0003077691990000046
Figure BDA0003077691990000047
分别为频率f1、f2信号的载波相位观测值和伪距率观测值,/>
Figure BDA0003077691990000048
表示卫星i消除电离层延迟的模糊度;
将消除电离层组合的观测值相减,消除接收机钟差;
将高度角最优的卫星m选为参考卫星,那么卫星i相对于卫星m观测值的单差为:
Figure BDA0003077691990000049
Figure BDA00030776919900000410
优选地,所述的构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型将误差校正后的卫星观测数据作为量测,通过非线性卡尔曼滤波器求解所述GPS+BDS PPP/IMU紧组合模型,滤波估计解算列车的位置信息,包括:
构建GPS+BDS PPP/IMU紧组合模型,将IMU输出的结果转化为伪距和伪距率,与接收机获取的伪距和伪距率做差得到卡尔曼滤波中的测量值;
惯导递推更新包括姿态、速度和位置三个方面的更新:
Figure BDA00030776919900000411
Figure BDA00030776919900000412
Figure BDA0003077691990000051
其中,b指载体坐标系,n指导航坐标系,
Figure BDA0003077691990000052
和/>
Figure BDA0003077691990000053
指姿态四元数和其变化率,vn和/>
Figure BDA0003077691990000054
分别是速度和速度变化率,pn和/>
Figure BDA0003077691990000055
分别是位置和位置变化率,/>
Figure BDA0003077691990000056
是角速度的斜对称矩阵,fn是加速度计测量值,gn是当地重力加速度,/>
Figure BDA0003077691990000057
和/>
Figure BDA0003077691990000058
分别是相对于惯性坐标系和地心地固坐标系的角速度;
实时非线性卡尔曼滤波器的状态向量、系统的测量矩阵、系统的测量值、测量噪声协方差,如下所示:
状态向量包含列车状态信息,惯导器件误差和无法模型化校正的未知参数,表示为:
Figure BDA0003077691990000059
其中,δp表示三维位置误差,δv表示三维速度误差,
Figure BDA00030776919900000510
表示三维姿态误差,ε表示加速度计器件误差,▽表示陀螺仪器件误差,l表示IMU和GNSS之间的杆臂,ΔNIF表示消除电离层误差后的载波相位模糊度差,α和β分别是当前历元GPS和BDS的参考卫星,p和q分别是当前历元GPS和BDS除参考卫星外的可观测卫星总数,Δdwet表示对流层湿分量。
测量矩阵为:
Figure BDA00030776919900000511
其中,
Figure BDA00030776919900000512
是地心地固坐标系到导航坐标系的姿态转换矩阵,Mwet是对流层湿分量系数,e是表示卫星-用户速度差沿视线方向单位矢量投影。
Figure BDA00030776919900000513
Figure BDA0003077691990000061
其中,(xs,ys,zs)和(xr,yr,zr)分别为卫星和接收机的三维坐标。
测量值为星间单差消除电离层后的载波相位和伪距率之差:
Figure BDA0003077691990000062
其中:
Figure BDA0003077691990000063
表示从列车接收机获取的载波相位和伪距率,/>
Figure BDA0003077691990000064
表示根据惯导递推结果计算出来的载波相位和伪距率,表示如下,
Figure BDA0003077691990000065
Figure BDA0003077691990000066
其中,vs是卫星速度,vI是惯导递推得到的速度。
因为量测中对载波相位和伪距率都进行了星间单差的操作,所以测量噪声协方差矩阵写为:
Figure BDA0003077691990000067
Figure BDA0003077691990000068
Figure BDA0003077691990000069
其中,
Figure BDA00030776919900000610
和/>
Figure BDA00030776919900000611
分别表示GPS或BDS的载波相位和伪距率的先验噪声方差;
根据非线性卡尔曼滤波器解算出的列车状态信息反馈校正惯性传感器的输出结果,获取实时的列车位置信息。
由上述本发明的实施例提供的技术方案可以看出,本发明实施例通过对列车行驶过程中卫星原始观测数据和惯性传感器输出数据的采集,以及对超快速高精度轨道产品的数据处理分析,由多星座条件下精密单点定位/惯性导航紧组合系统解算获取列车运行位置信息,具有无需轨旁设备、数据输出频率高、定位结果精度较高的特点。
本发明附加的方面和优点将在下面的描述中部分给出,这些将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图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格式文件对卫星天线质心位置进行校正。
进一步地,列车运行过程中,卫星信号的载波相位和伪距率观测方程可以如下所示:
Figure BDA0003077691990000091
Figure BDA0003077691990000092
其中:s表示GPS或者BDS卫星,φi表示卫星i的载波相位观测值,Di表示卫星i的伪距率观测值,ρi表示卫星i到列车接收机的几何距离,
Figure BDA0003077691990000093
表示列车实际运行过程中电离层延迟,/>
Figure BDA0003077691990000094
表示列车实际运行过程中对流层延迟,c表示光速,dtr表示接收机的时钟误差,dtS,i表示卫星i的时钟误差,Ni表示卫星i的模糊度,λ表示载波相位的波长,/>
Figure BDA0003077691990000095
表示残差。
在以上观测方程基础上,使用消电离层组合近似消除电离层延迟,则观测方程可以改写为:
Figure BDA0003077691990000101
Figure BDA0003077691990000102
其中:f1、f2为GNSS信号频率,λ1、λ2分别为频率f1、f2信号的波长,
Figure BDA0003077691990000103
和/>
Figure BDA0003077691990000104
分别为消去电离层延迟之后的载波相位和伪距率观测值,/>
Figure BDA0003077691990000105
和/>
Figure BDA0003077691990000106
Figure BDA0003077691990000107
分别为频率f1、f2信号的载波相位观测值和伪距率观测值,/>
Figure BDA0003077691990000108
表示卫星i消除电离层延迟的模糊度。
将消除电离层组合的观测值相减,可消除接收机钟差,减少误差参数,将高度角最优的卫星m选为参考卫星,那么卫星i相对于卫星m观测值的单差为:
Figure BDA0003077691990000109
Figure BDA00030776919900001010
步骤S230:构建GPS+BDS PPP/IMU紧组合模型,采用精密单点定位模型将误差校正后的卫星观测数据作为量测,通过非线性卡尔曼滤波器求解所述GPS+BDS PPP/IMU紧组合模型,滤波估计解算列车的位置信息。
本发明实施例的列车定位方法采用紧组合方式,系统需要将IMU输出的结果转化为伪距和伪距率,与接收机获取的伪距和伪距率做差得到卡尔曼滤波中的测量值,因采用的载波相位和伪距率是接收机的原始信息,结果会具有更好的连续性和稳定性,并且在卫星颗数小于三的情况下仍然能够输出定位结果。
惯导递推更新包括姿态、速度和位置三个方面的更新:
Figure BDA0003077691990000111
Figure BDA0003077691990000112
Figure BDA0003077691990000113
其中,b指载体坐标系,n指导航坐标系,
Figure BDA0003077691990000114
和/>
Figure BDA0003077691990000115
指姿态四元数和其变化率,vn和/>
Figure BDA0003077691990000116
分别是速度和速度变化率,pn和/>
Figure BDA0003077691990000117
分别是位置和位置变化率,/>
Figure BDA0003077691990000118
是角速度的斜对称矩阵,fn是加速度计测量值,gn是当地重力加速度,/>
Figure BDA0003077691990000119
和/>
Figure BDA00030776919900001110
分别是相对于惯性坐标系和地心地固坐标系的角速度。
实时非线性卡尔曼滤波器的状态向量、系统的测量矩阵、系统的测量值、测量噪声协方差,如下所示:
状态向量包含列车状态信息,惯导器件误差和无法模型化校正的未知参数,表示为:
Figure BDA00030776919900001111
其中,δp表示三维位置误差,δv表示三维速度误差,
Figure BDA00030776919900001112
表示三维姿态误差,ε表示加速度计器件误差,▽表示陀螺仪器件误差,l表示IMU和GNSS之间的杆臂,ΔNIF表示消除电离层误差后的载波相位模糊度差,α和β分别是当前历元GPS和BDS的参考卫星,p和q分别是当前历元GPS和BDS除参考卫星外的可观测卫星总数,Δdwet表示对流层湿分量。
测量矩阵为:
Figure BDA0003077691990000121
其中,
Figure BDA0003077691990000122
是地心地固坐标系到导航坐标系的姿态转换矩阵,Mwet是对流层湿分量系数,e是表示卫星-用户速度差沿视线方向单位矢量投影。/>
Figure BDA0003077691990000123
Figure BDA0003077691990000124
其中,(xs,ys,zs)和(xr,yr,zr)分别为卫星和接收机的三维坐标。
测量值为星间单差消除电离层后的载波相位和伪距率之差:
Figure BDA0003077691990000125
其中:
Figure BDA0003077691990000126
表示从列车接收机获取的载波相位和伪距率,/>
Figure BDA0003077691990000127
表示根据惯导递推结果计算出来的载波相位和伪距率,表示如下,
Figure BDA0003077691990000128
Figure BDA0003077691990000129
其中,vs是卫星速度,vI是惯导递推得到的速度。
因为量测中对载波相位和伪距率都进行了星间单差的操作,所以测量噪声协方差矩阵写为:
Figure BDA00030776919900001210
Figure BDA0003077691990000131
Figure BDA0003077691990000132
其中,
Figure BDA0003077691990000133
和/>
Figure BDA0003077691990000134
分别表示GPS或BDS的载波相位和伪距率的先验噪声方差。
根据非线性卡尔曼滤波器解算出的列车状态信息反馈校正惯性传感器的输出结果,获取实时的列车位置信息。
根据上述各模型并通过本发明方法可以得出以下实验结果:
在列车运行的过程中,实时记录安装在列车上的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输出的结果转化为伪距和伪距率,与接收机获取的伪距和伪距率做差得到卡尔曼滤波中的测量值;
惯导递推更新包括姿态、速度和位置三个方面的更新:
Figure FDA0004216988760000011
Figure FDA0004216988760000012
Figure FDA0004216988760000013
其中,b指载体坐标系,n指导航坐标系,
Figure FDA0004216988760000014
和/>
Figure FDA0004216988760000015
指姿态四元数和其变化率,vn和/>
Figure FDA0004216988760000016
分别是速度和速度变化率,pn和/>
Figure FDA0004216988760000017
分别是位置和位置变化率,/>
Figure FDA0004216988760000018
是角速度的斜对称矩阵,fn是加速度计测量值,gn是当地重力加速度,/>
Figure FDA0004216988760000019
和/>
Figure FDA00042169887600000110
分别是相对于惯性坐标系和地心地固坐标系的角速度;
实时非线性卡尔曼滤波器的状态向量、系统的测量矩阵、系统的测量值、测量噪声协方差,如下所示:
状态向量包含列车状态信息,惯导器件误差和无法模型化校正的未知参数,表示为:
Figure FDA0004216988760000021
其中,δp表示三维位置误差,δv表示三维速度误差,
Figure FDA0004216988760000022
表示三维姿态误差,ε表示加速度计器件误差,/>
Figure FDA0004216988760000023
表示陀螺仪器件误差,l表示IMU和GNSS之间的杆臂,ΔNIF表示消除电离层误差后的载波相位模糊度差,α和β分别是当前历元GPS和BDS的参考卫星,p和q分别是当前历元GPS和BDS除参考卫星外的可观测卫星总数,Δdwet表示对流层湿分量;
测量矩阵为:
Figure FDA0004216988760000024
其中,
Figure FDA0004216988760000025
是地心地固坐标系到导航坐标系的姿态转换矩阵,Mwet是对流层湿分量系数,e是表示卫星-用户速度差沿视线方向单位矢量投影;
Figure FDA0004216988760000026
Figure FDA0004216988760000027
/>
其中,(xs,ys,zs)和(xr,yr,zr)分别为卫星和接收机的三维坐标;
测量值为星间单差消除电离层后的载波相位和伪距率之差:
Figure FDA0004216988760000028
其中:
Figure FDA0004216988760000031
表示根据惯导递推结果计算出来的载波相位和伪距率,表示如下:
Figure FDA0004216988760000032
Figure FDA0004216988760000033
其中,vs是卫星速度,vI是惯导递推得到的速度;
因为量测中对载波相位和伪距率都进行了星间单差的操作,所以测量噪声协方差矩阵写为:
Figure FDA0004216988760000034
Figure FDA0004216988760000035
Figure FDA0004216988760000036
其中,
Figure FDA0004216988760000037
和/>
Figure FDA0004216988760000038
分别表示GPS或BDS的载波相位和伪距率的先验噪声方差;根据非线性卡尔曼滤波器解算出的列车状态信息反馈校正惯性传感器的输出结果,获取实时的列车位置信息;
所述的根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正,包括:
列车运行过程中,卫星信号的载波相位和伪距率观测方程如下所示:
Figure FDA0004216988760000039
Figure FDA00042169887600000310
其中:s表示GPS或者BDS卫星,φi表示卫星i的载波相位观测值,Di表示卫星i的伪距率观测值,ρi表示卫星i到列车接收机的几何距离,
Figure FDA0004216988760000041
表示列车实际运行过程中电离层延迟,
Figure FDA0004216988760000042
表示列车实际运行过程中对流层延迟,c表示光速,dtr表示接收机的时钟误差,dtS,i表示卫星i的时钟误差,Ni表示卫星i的模糊度,λ表示载波相位的波长,/>
Figure FDA0004216988760000043
表示残差;
在以上观测方程基础上,使用消电离层组合消除电离层延迟,则观测方程改写为:
Figure FDA0004216988760000044
Figure FDA0004216988760000045
其中:f1、f2为GNSS信号频率,λ1、λ2分别为频率f1、f2信号的波长,
Figure FDA0004216988760000046
和/>
Figure FDA0004216988760000047
分别为消去电离层延迟之后的载波相位和伪距率观测值,/>
Figure FDA0004216988760000048
和/>
Figure FDA00042169887600000413
Figure FDA0004216988760000049
分别为频率f1、f2信号的载波相位观测值和伪距率观测值,/>
Figure FDA00042169887600000410
表示卫星i消除电离层延迟的模糊度;
将消除电离层组合的观测值相减,消除接收机钟差;
将高度角最优的卫星m选为参考卫星,那么卫星i相对于卫星m观测值的单差为:
Figure FDA00042169887600000411
Figure FDA00042169887600000412
2.根据权利要求1所述的方法,其特征在于,所述的在列车运行过程中,从列车接收机获取卫星观测数据,从国际GNSS服务组织IGS获取卫星轨道数据,包括:
在列车运行过程中,从列车接收机获取卫星观测数据,所述卫星观测数据包括伪距、载波相位和伪距率;
从IGS获取卫星轨道数据,所述卫星轨道数据包括IGS发布的实时精密星历,对实时精密星历中的数据进行卫星轨道和卫星钟差插值计算处理,得到所需频率的卫星位置和钟差。
3.根据权利要求2所述的方法,其特征在于,所述的根据精密单点定位误差模型对所述卫星观测数据和卫星轨道数据进行误差校正,包括:
运用双频消除电离层组合模型减少所述卫星观测数据的电离层延迟,采用Saastamoinen模型校正所述卫星观测数据的对流层干延迟分量,用运动学公式修正所述卫星观测数据中地球自转效应带来的位置偏移,使用IGS提供的ANTEX格式文件对卫星天线质心位置进行校正。
CN202110557425.2A 2021-05-21 2021-05-21 一种基于gps+bds ppp/imu紧组合的列车定位方法 Active CN113203414B (zh)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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 中国人民解放军国防科技大学 一种卫星和惯性组合动对动实时精密相对定位方法

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