CN108931799A - 基于递归快速正交搜索的列车组合定位方法及系统 - Google Patents
基于递归快速正交搜索的列车组合定位方法及系统 Download PDFInfo
- Publication number
- CN108931799A CN108931799A CN201810790879.2A CN201810790879A CN108931799A CN 108931799 A CN108931799 A CN 108931799A CN 201810790879 A CN201810790879 A CN 201810790879A CN 108931799 A CN108931799 A CN 108931799A
- Authority
- CN
- China
- Prior art keywords
- data
- error
- nonlinear
- speed
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000001914 filtration Methods 0.000 claims abstract description 30
- 238000012549 training Methods 0.000 claims abstract description 14
- 239000011159 matrix material Substances 0.000 claims description 41
- 238000005259 measurement Methods 0.000 claims description 18
- 230000004927 fusion Effects 0.000 claims description 16
- 238000010845 search algorithm Methods 0.000 claims description 7
- 238000012546 transfer Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000006870 function Effects 0.000 description 27
- 238000010586 diagram Methods 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 238000004891 communication Methods 0.000 description 3
- 238000013473 artificial intelligence Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000007405 data analysis Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 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
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)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于递归快速正交搜索的列车组合定位方法及系统,其中,方法,包括:获取实时数据;构建系统非线性误差模型;判断卫星信号是否良好;若卫星信号良好,则使用扩展卡尔曼滤波算法对所述实时数据进行融合,并且将扩展卡尔曼滤波算法的预测值作为输入,系统非线性误差模型的非线性速度误差作为输出,进行模型训练;如在卫星信号较差,则使用递归正交搜索算法进行在线建模,结合所述扩展卡尔曼滤波算法的预测值对系统非线性误差模型的非线性速度误差进行估计,从而补偿输出的速度信息,并利用补偿后的速度信息计算当前的位置信息,从而得到修正后的速度和位置信息。提高了在卫星信号受到干扰时列车定位的精度。
Description
技术领域
本发明涉及列车定位领域,具体地,涉及一种基于递归快速正交搜索的列车组合定位方法及系统。
背景技术
列车定位是列车运行控制系统重要的组成部分之一,列控系统需要在实时获取列车准确位置的前提下进行控制决策。现有列控系统的列车定位单元主要使用轨道电路、应答器等轨旁设备,并需要定期的维护和更换。现有的列车运行控制系统主要采用GNSS(Global Navigation Satellite System,全球导航卫星系统)与INS(InertialNavigation System,惯性导航系统)组合的定位方式作为列车定位单元,GNSS/INS组合定位方法具有定位精度高、自主性能好等特点,能够有效提高整个系统的容错能力、位置信息可信度以及时间-空间覆盖范围,是当前列车测速定位技术的重要发展方向。完整的列车组合定位系统主要包括以下几个部分:定位传感器、定位计算处理单元以及接口模块,其中定位传感器主要依靠外界信号(GNSS卫星播发信号)或随安装情况自主感应(IMU,InertialMeasurement Unit,惯性测量单元)列车实时运行状态,通过定位计算处理模块进行传感器数据解析以及位置计算,然后将结果由接口模块输出至相关功能模块。
然而,由于列车运行环境复杂多样,运行途中需要经过隧道或峡谷等卫星信号受到严重干扰的区域,从而导致GNSS服务中断或产生多径效应,进而使得定位精度下降。另一方面,虽然INS作为一种独立的方法能够提供短期精度较高的定位结果,但是由于受到噪声影响以及自身传感器的误差,随着时间的推移,INS的性能会迅速恶化,特别是在GNSS信号中断期间,在没有外部校正的情况下INS会产生严重的定位误差。虽然通过利用GNSS和INS的互补特性,将它们的测量结果融合,通常使用卡尔曼滤波器(Kalman Filter,KF)消除INS误差的线性部分来补偿系统输出,但是由于KF是基于高斯白噪声驱动的线性误差状态模型,这不足以描述INS的非线性误差。扩展卡尔曼滤波(Extended Kalman Filter,EKF)通过在非线性系统上应用一阶近似使用线性化模型。但是,线性化会导致高非线性系统的滤波器性能差和发散。无迹卡尔曼滤波(Unscented Kalman Kilter,UKF)是一种可提供更好性能的替代方法。然而,UKF需要花费比EKF更多的计算时间来计算非线性变换的随机变量的统计量。
为了克服KF及其变型的局限性,需要不依赖线性动态模型和平稳随机误差的非线性技术。埃尔希米等(2004)提出了基于自适应神经模糊推理系统(Adaptive Neuro-FuzzyInference System,ANFIS)模块的人工智能(Artificial Intelligence,AI)算法作为解决方法。但是基于人工智能的方法都需要较长的训练时间,不能保证系统的实时性。此外,它们高度依赖训练数据的一致性,容易陷入局部极小点,并且算法精度仍有待提高。
发明内容
本发明的目的在于,针对上述问题,提出一种基于递归快速正交搜索的列车组合定位方法及系统,以实现至少部分的解决现有技术中存在的问题。
为实现上述目的,本发明采用的技术方案是:
一种基于递归快速正交搜索的列车组合定位方法,包括:
获取实时数据;
构建系统非线性误差模型;
判断卫星信号是否良好;
若卫星信号良好,则使用扩展卡尔曼滤波算法对所述实时数据进行融合,并且将扩展卡尔曼滤波算法的预测值作为输入,系统非线性误差模型的非线性速度误差作为输出,对系统非线性误差模型进行模型训练;
如在卫星信号较差,则使用递归正交搜索算法对系统非线性误差模型进行在线建模,结合所述扩展卡尔曼滤波算法的预测值对系统非线性误差模型的非线性速度误差进行估计,从而补偿输出的速度信息,并利用补偿后的速度信息计算当前的位置信息,从而得到修正后的速度和位置信息。
优选的,所述获取实时数据中,所述实时数据,包括:
惯性传感器数据和卫星定位数据。
优选的,所述卫星定位数据,包括:经度、纬度、高度、东向速度、北向速度和天向速度;
所述惯性传感器数据,包括:三轴加速度信息和三轴陀螺信息。
优选的,所述获取实时数据之后,还包括对所述惯性传感器数据进行解算,从而得到定位信息。
优选的,所述若卫星信号良好,则使用扩展卡尔曼滤波算法对所述实时数据进行融合,并且将扩展卡尔曼滤波算法的预测值作为输入,系统非线性误差模型的非线性速度误差作为输出,对系统非线性误差模型进行模型训练中的使用扩展卡尔曼滤波算法对所述实时数据进行融合,具体为:使用扩展卡尔曼滤波算法将所述卫星定位数据与所述定位信息进行融合。
优选的,所述非线性速度误差为:
ΔV=VINS-VGPS-δVEKF,
其中,ΔV为系统非线性误差模型的非线性速度误差;VINS为对惯性传感器数据进行解算得到的速度,VGPS为卫星测量得到的速度,δVEKF为扩展卡尔曼滤波算法的速度误差。
优选的,所述构建系统非线性误差模型,具体为构建高阶误差模型。
优选的,所述扩展卡尔曼滤波算法,包括:
设定扩展卡尔曼滤波算法的状态方程和观测方程;
计算状态初始值,设定误差协方差矩阵;
计算所述状态方程中状态转移函数的雅可比矩阵;
基于所述状态转移函数的雅可比矩阵计算状态向量一步预测误差方差矩阵;
计算所述观测方程中量测函数的雅可比矩阵;
基于所述量测函数的雅可比矩阵和状态向量一步预测误差方差矩阵计算状态增益矩阵;
基于所述状态增益矩阵得到k时刻状态向量估计值;
基于所述k时刻状态向量估计值、所述状态增益矩阵和所述量测函数的雅可比矩阵更新误差协方差矩阵。
本发明技术方案还公开一种基于递归快速正交搜索的列车组合定位系统,包括,
GNSS数据采集模块、惯导数据采集模块、GNSS数据逻辑模块、惯导数据逻辑模块和数据融合模块,所述GNSS数据采集模块获取的卫星定位数据经GNSS数据逻辑模块输入至数据融合模块,所述惯导数据采集模块获取的惯性传感器数据经惯导数据逻辑模块输入至数据融合模块。
优选的,还包括:
数据输出模块和电源模块,所述数据融合模块的输出端与所述数据输出模块的输入端电连接;所述电源模块为系统提供电源。
本发明的技术方案具有以下有益效果:
本发明的技术方案,基于递归快速正交搜索的列车组合定位方法与系统,采用扩展卡尔曼滤波算法与递归快速正交搜索算法结合,提高在卫星信号受到干扰时列车定位的精度。
还具有以下优点:
1、本发明采用卫星定位数据与惯性导航解算数据融合,提高了列车定位信息的精度与可靠性。
2、本发明采用扩展卡尔曼滤波算法进行定位信息的融合,实际系统总是存在不同程度的非线性,对于非线性系统,采用扩展卡尔曼滤波算法可以通过线性化方法将非线性系统转换为近似的线性系统,对系统误差进行估计与补偿。
3、本发明采用递归快速正交搜索算法,该算法能够识别具有复杂动力学的非线性系统,在满足系统定位实时性要求的同时能够有效地模拟状态估计后的残差,本发明将递归快速正交搜索算法与扩展卡尔曼滤波算法结合,以克服线性化导致系统性能差和发散的问题,提高卫星信号受干扰情况下列车定位的精度。
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
附图说明
图1为本发明实施例所述的基于递归快速正交搜索的列车组合定位方法的流程图;
图2为本发明实施例所述的模型训练示意图;
图3为本发明实施例所述的误差估计示意图;
图4为本发明实施例所述的RFOS算法流程图
图5为本发明实施例所述的基于递归快速正交搜索的列车组合定位系统的原理框图。
具体实施方式
以下结合附图对本发明的优选实施例进行说明,应当理解,此处所描述的优选实施例仅用于说明和解释本发明,并不用于限定本发明。
如图1所示,一种基于递归快速正交搜索的列车组合定位方法,包括:
S101:获取实时数据;
S102:构建系统非线性误差模型(RFOS模型);
S103:判断卫星信号是否良好;
S104:若卫星信号良好,则使用扩展卡尔曼滤波算法(EKF)对实时数据进行融合,并且将扩展卡尔曼滤波算法的预测值作为输入,系统非线性误差模型的非线性速度误差作为输出,对系统非线性误差模型进行模型训练;
S105:如在卫星信号较差,则使用递归正交搜索算法(RFOS)对系统非线性误差模型进行在线建模,结合扩展卡尔曼滤波算法的预测值对系统非线性误差模型的非线性速度误差进行估计,从而补偿输出的速度信息,并利用补偿后的速度信息计算当前的位置信息,从而得到修正后的速度和位置信息。
优选的方案中,获取实时数据中,实时数据,包括:
惯性传感器数据和卫星定位数据。
优选的方案中,卫星定位数据,包括:经度、纬度、高度、东向速度、北向速度和天向速度;
惯性传感器数据,包括:三轴加速度信息和三轴陀螺信息。
优选的方案中,获取实时数据之后,还包括对惯性传感器数据进行解算,从而得到定位信息。
优选的方案中,若卫星信号良好,则使用扩展卡尔曼滤波算法对实时数据进行融合,并且将扩展卡尔曼滤波算法的预测值作为输入,系统非线性误差模型的非线性速度误差作为输出,对系统非线性误差模型进行模型训练中的使用扩展卡尔曼滤波算法对实时数据进行融合,具体为:使用扩展卡尔曼滤波算法将卫星定位数据与定位信息进行融合。
优选的方案中,构建系统非线性误差模型,具体为构建高阶误差模型。
所建立的系统非线性误差模型具体为:
惯性系统的动态误差状态通常描述如下:
其中,M是地球的子午曲率半径,N是地球的曲率半径。矩阵为载体坐标系到导航坐标系的转换矩阵。fx、fy和fz是导航系下的加速度。o(δP,δV)、o(δP,δV,δθ)和o(δP,δV,δθ)分别表示与位置误差(δP),速度误差(δV),姿态误差(δθ)及其高阶项有关的高阶项。
系统状态变量为δ代表误差,其中p为俯仰角、r为侧倾角、A为方位角;Ve为东向速度、Vn为北向速度、Vu为天向速度;为纬度、λ为经度、h为高度。
建立高阶误差模型为:
式中:Vt为采样周期,am为Pm(k)的权重系数,Pm(k)为候选函数,ε(k)为系统残差。
优选的方案中,扩展卡尔曼滤波算法,包括:
设定扩展卡尔曼滤波算法的状态方程和观测方程:
xk=f(xk-1,uk-1,wk-1) (5),
zk=h(xk,vk) (6)。
计算状态初始值,设定误差协方差矩阵,误差协方差矩阵为P0:
计算状态方程中状态转移函数的雅可比(Jacobi)矩阵:
基于状态转移函数的雅可比矩阵计算状态向量一步预测误差方差矩阵;
计算观测方程中量测函数的雅可比矩阵:
基于量测函数的雅可比矩阵和状态向量一步预测误差方差矩阵计算状态增益矩阵:
基于状态增益矩阵得到k时刻状态向量估计值:
基于k时刻状态向量估计值、状态增益矩阵和量测函数的雅可比矩阵更新误差协方差矩阵:
式中:I为单位矩阵,nx为状态向量的维数,xk为状态向量,uk-1为控制向量,
wk-1为模型噪声,zk为观测向量,vk为量测噪声,f(·)为非线性状态转移函数,h(·)为非线性量测函数,Qk-1为k-1时刻的模型噪声协方差矩阵,Rk为k时刻的量测噪声协方差矩阵。
优选的方案中,在卫星信号良好的情况下,将EKF的预测值作为输入,非线性速度误差VV作为输出,进行模型训练,得到由多个候选函数Pm(k)组成的系统模型,模型训练示意图如图2所示。
图2模型训练中,
在卫星信号良好的情况下,将EKF的预测值作为输入,非线性速度误差VV作为输出,进行模型训练,得到由多个候选函数组成的系统模型。图中,PINS、VINS、θINS为惯导解算得到的位置、速度、姿态信息,PGPS、VGPS、θGPS为GPS量测信息,δPEKF、δVEKF、δθEKF为扩展卡尔曼滤波的预测值。
非线性速度误差为:
ΔV=VINS-VGPS-δVEKF (14),
其中,ΔV为系统非线性误差模型的非线性速度误差;VINS为对惯性传感器数据进行解算得到的速度,VGPS为卫星测量得到的速度,δVEKF为扩展卡尔曼滤波算法的速度误差。
在卫星信号受到干扰导致系统定位精度下降时,递归快速正交搜索(RFOS)算法进行在线建模,结合EKF预测值对VV进行估计,补偿速度输出,并利用补偿后的速度信息计算当前的位置信息,误差估计示意图如图3所示。图3中:在卫星信号受到干扰导致系统定位精度下降时,递归快速正交搜索(RFOS)算法进行在线建模,结合EKF预测值对VV进行估计,补偿速度输出,并利用补偿后的速度信息计算当前的位置信息。
RFOS算法流程图如图4所示,其主要过程为:
在一般情况下,一个非线性系统可以被表示为一个差分方程,如式(15):
y(k)=F[y(k-1),...,y(k-K),x(k),...,x(k-L)]+ε(k) (15),
其中,F[·]是形式未知的连续非线性函数,y(k)和x(k)分别为系统的输出和输入,ε(k)是系统残差,假设系统的输入x(k)和输出y(k)的最大的数据记录时间长度是有限的,直到N0(1≤K≤N0,0≤L≤N0),N0表示常数。式(15)可以改写为以下的形式:
其中,Pm(k)为非正交的候选函数,是由有效的输入信号构成。am是Pm(k)的权重系数。Pm(k)可以表示为如下形式:
Pm(k)=y(k-n1),...,y(k-ni),x(k-l1),...,x(k-lj) (17),
其中,i≥0,1≤n1≤N0…,1≤ni≤N0,j≥0,1≤l1≤N0…,1≤lj≤N0。
此时,系统的均方误差MSE表示为:
式(18)上方的横线表示数据记录在时间长度的平均值,该算法在所有的候选函数Pm(k)中进行搜索,选择对均方误差贡献最大的候选函数作为模型项,添加到构建的辨识模型当中。
为了实现这一搜索过程,首先要得到未知结构的非线性系统模型,利用格拉姆-施密特(Gram-Schmidt,GS)正交方法,可以将式(16)改写为:
其中,gm是正交函数wm(k)的权值,ε(k)表示残差,wm(k)是利用格拉姆-施密特正交方法将非正交候选函数Pm(k)正交化后得到的两两正交的函数序列,如下所示:
具体计算过程如下:
w1(k)=P1(k)=1
w2(k)=P2(k)-α21w1(k)
其中正交系数:
此时系统的均方误差改写为如下形式:
其中,
更新的MSE被反馈以进行下一次迭代搜索最佳候选Pm(k),直到满足停止标准。
在整个循环过程中,FOS使用公式(14)来表示Pm(k)与正交函数wr(k)之间的相关性。公式(26)表示系统输出y(k)与wm(k)之间的相关性。αri和αmr是GS权重。
公式(24)-(26)表明,D(m,r)、C(m)、αmr、gm和Qm的更新可以在每次迭代中递归实现,D(m,r)、C(m)是为了更直观的表示各个公式之间的关系,引入的中间函数,Qm为均方误差MSE的减小量。然而,正交函数的计算非常耗费时间,而且需要内存有相当大的数据存储空间。为了避免上述问题,快速正交搜索算法采用隐式正交法,不用单独计算出每一个正交函数wm(k),只需计算出正交系数αmr。因此,可得如下等式:
同样式(22)的分母可以表示为下面的形式:
这样,αmr的值就可以通过式(28)和(29)计算出来,同样的道理,式(24)的分子、分母也可以改写为如下形式:
从而gm就可以由式(30)和(31)计算出来。
当搜索完成时,其中搜索停止的条件主要有三个:一个是当系统的剩余误差达到一个足够小的程度;二是一定数量的模型项已经被选出;三是剩余的候选函数不能使系统的误差产生足够的减小量,利用αmr和gm可以计算出被选出的模型项Pm(n)的系数am。
其中
为了模型实时更新,需要在线更新以下项:
在式(14)中更新
在式(15)中更新
本发明技术方案还公开一种基于递归快速正交搜索的列车组合定位系统,如图5所示,包括,
GNSS数据采集模块、惯导数据采集模块、GNSS数据逻辑模块、惯导数据逻辑模块和数据融合模块,GNSS数据采集模块获取的卫星定位数据经GNSS数据逻辑模块输入至数据融合模块,惯导数据采集模块获取的惯性传感器数据经惯导数据逻辑模块输入至数据融合模块。
优选的方案中,还包括:
数据输出模块和电源模块,数据融合模块的输出端与数据输出模块的输入端电连接;电源模块为系统提供电源,电源模块为安全电源模块。
其中GNSS数据采集模块中所用GNSS传感器为GNSS接收机K700。
惯导数据采集模块中所用惯性测量单元(IMU)传感器为3DM-AHRS300A航姿参考系统。
GNSS数据逻辑模块和惯导数据逻辑模块中所用微处理器为STM32F103ZET6。
数据融合模块采用的微处理器型号为DSP28335。
GNSS数据采集模块和GNSS数据逻辑模块采用RS232串行通信连接。
系统中信号的输入输出采用航空接口,以保证在各种复杂的情况下依旧能够保证线路连接的安全。
在具体的实施方案中,系统还包括上位机,
GPS数据采集模块和GPS数据逻辑模块通过RS232通信方式连接,惯导数据采集模块和惯导数据逻辑模块通过RS232通信方式连接,GPS数据逻辑模块、惯导数据逻辑模块分别和数据融合模块连接,数据融合模块电连接数据输出模块,数据输出模块电连接上位机。安全电源模块负责给整个系统供电。上位机包括数据显示和数据下载,数据显示的内容包括列车定位结果、列车行车轨迹、和列车速度实时解算曲线。可下载数据包括:列车行车位置信息、IMU原始信息及相应的时间信息。
最后应说明的是:以上所述仅为本发明的优选实施例而已,并不用于限制本发明,尽管参照前述实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于递归快速正交搜索的列车组合定位方法,其特征在于,包括:
获取实时数据;
构建系统非线性误差模型;
判断卫星信号是否良好;
若卫星信号良好,则使用扩展卡尔曼滤波算法对所述实时数据进行融合,并且将扩展卡尔曼滤波算法的预测值作为输入,系统非线性误差模型的非线性速度误差作为输出,对系统非线性误差模型进行模型训练;
如在卫星信号较差,则使用递归正交搜索算法对系统非线性误差模型进行在线建模,结合所述扩展卡尔曼滤波算法的预测值对系统非线性误差模型的非线性速度误差进行估计,从而补偿输出的速度信息,并利用补偿后的速度信息计算当前的位置信息,从而得到修正后的速度和位置信息。
2.根据权利要求1所述的基于递归快速正交搜索的列车组合定位方法,其特征在于,所述获取实时数据中,所述实时数据,包括:
惯性传感器数据和卫星定位数据。
3.根据权利要求2所述的基于递归快速正交搜索的列车组合定位方法,其特征在于:
所述卫星定位数据,包括:经度、纬度、高度、东向速度、北向速度和天向速度;
所述惯性传感器数据,包括:三轴加速度信息和三轴陀螺信息。
4.根据权利要求2所述的基于递归快速正交搜索的列车组合定位方法,其特征在于,所述获取实时数据之后,还包括对所述惯性传感器数据进行解算,从而得到定位信息。
5.根据权利要求4所述的基于递归快速正交搜索的列车组合定位方法,其特征在于,所述若卫星信号良好,则使用扩展卡尔曼滤波算法对所述实时数据进行融合,并且将扩展卡尔曼滤波算法的预测值作为输入,系统非线性误差模型的非线性速度误差作为输出,对系统非线性误差模型进行模型训练中的使用扩展卡尔曼滤波算法对所述实时数据进行融合,具体为:使用扩展卡尔曼滤波算法将所述卫星定位数据与所述定位信息进行融合。
6.根据权利要求1所述的基于递归快速正交搜索的列车组合定位方法,其特征在于:所述非线性速度误差为:
ΔV=VINS-VGPS-δVEKF,
其中,ΔV为系统非线性误差模型的非线性速度误差;VINS为对惯性传感器数据进行解算得到的速度,VGPS为卫星测量得到的速度,δVEKF为扩展卡尔曼滤波算法的速度误差。
7.根据权利要求1所述的基于递归快速正交搜索的列车组合定位方法,其特征在于:所述构建系统非线性误差模型,具体为构建高阶误差模型。
8.根据权利要求1所述的基于递归快速正交搜索的列车组合定位方法,其特征在于:所述扩展卡尔曼滤波算法,包括:
设定扩展卡尔曼滤波算法的状态方程和观测方程;
计算状态初始值,设定误差协方差矩阵;
计算所述状态方程中状态转移函数的雅可比矩阵;
基于所述状态转移函数的雅可比矩阵计算状态向量一步预测误差方差矩阵;
计算所述观测方程中量测函数的雅可比矩阵;
基于所述量测函数的雅可比矩阵和状态向量一步预测误差方差矩阵计算状态增益矩阵;
基于所述状态增益矩阵得到k时刻状态向量估计值;
基于所述k时刻状态向量估计值、所述状态增益矩阵和所述量测函数的雅可比矩阵更新误差协方差矩阵。
9.一种基于递归快速正交搜索的列车组合定位系统,其特征在于:运行权利要求1至8任一所述的方法,包括,
GNSS数据采集模块、惯导数据采集模块、GNSS数据逻辑模块、惯导数据逻辑模块和数据融合模块,所述GNSS数据采集模块获取的卫星定位数据经GNSS数据逻辑模块输入至数据融合模块,所述惯导数据采集模块获取的惯性传感器数据经惯导数据逻辑模块输入至数据融合模块。
10.根据权利要求9所述的基于递归快速正交搜索的列车组合定位系统,其特征在于,还包括:
数据输出模块和电源模块,所述数据融合模块的输出端与所述数据输出模块的输入端电连接;所述电源模块为系统提供电源。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810790879.2A CN108931799A (zh) | 2018-07-18 | 2018-07-18 | 基于递归快速正交搜索的列车组合定位方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810790879.2A CN108931799A (zh) | 2018-07-18 | 2018-07-18 | 基于递归快速正交搜索的列车组合定位方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108931799A true CN108931799A (zh) | 2018-12-04 |
Family
ID=64447359
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810790879.2A Pending CN108931799A (zh) | 2018-07-18 | 2018-07-18 | 基于递归快速正交搜索的列车组合定位方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108931799A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109471143A (zh) * | 2018-12-11 | 2019-03-15 | 北京交通大学 | 自适应容错的列车组合定位方法 |
CN109765523A (zh) * | 2018-12-21 | 2019-05-17 | 山东省科学院海洋仪器仪表研究所 | 基于自适应akf的单应答器斜距水声定位方法及系统 |
CN110395297A (zh) * | 2019-07-29 | 2019-11-01 | 兰州交通大学 | 列车定位方法 |
CN112937640A (zh) * | 2021-03-18 | 2021-06-11 | 北京交通大学 | 基于卫星定位环境场景误差特征的列车安全包络计算方法 |
CN113581260A (zh) * | 2021-09-01 | 2021-11-02 | 兰州交通大学 | 一种基于gnss的列车轨道占用判别方法 |
CN113687396A (zh) * | 2021-09-26 | 2021-11-23 | 重庆赛迪奇智人工智能科技有限公司 | 定位处理方法、装置、定位设备、交通工具及存储介质 |
CN114348002A (zh) * | 2021-12-29 | 2022-04-15 | 江苏大学 | 一种轮毂电机驱动电动汽车的车速估计系统及方法 |
CN114440881A (zh) * | 2022-01-29 | 2022-05-06 | 海南大学 | 一种融合多源传感器信息的无人车定位方法 |
-
2018
- 2018-07-18 CN CN201810790879.2A patent/CN108931799A/zh active Pending
Non-Patent Citations (4)
Title |
---|
LI, RONG 等: "AUGMENTED FAST ORTHOGONAL SEARCH/KALMAN FILTERING (FOS/KF) POSITIONING AND ORIENTATION SOLUTION USING MEMS-BASED INERTIAL NAVIGATION SYSTEM (INS) IN DRILLING APPLICATIONS", 《INSTRUMENTATION SCIENCE & TECHNOLOGY》 * |
PETER T. JARDINE 等: "Recursive fast orthogonal search for real-time adaptive modelling of a quadcopter", 《2017 INTERNATIONAL CONFERENCE ON UNMANNED AIRCRAFT SYSTEMS (ICUAS)》 * |
王国臣 等: "《水下组合导航系统》", 30 April 2016, 北京:国防工业出版社 * |
王志伟 等: "基于快速正交搜索的车载导航方法", 《中国惯性技术学报》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109471143A (zh) * | 2018-12-11 | 2019-03-15 | 北京交通大学 | 自适应容错的列车组合定位方法 |
CN109471143B (zh) * | 2018-12-11 | 2023-05-05 | 北京交通大学 | 自适应容错的列车组合定位方法 |
CN109765523A (zh) * | 2018-12-21 | 2019-05-17 | 山东省科学院海洋仪器仪表研究所 | 基于自适应akf的单应答器斜距水声定位方法及系统 |
CN110395297A (zh) * | 2019-07-29 | 2019-11-01 | 兰州交通大学 | 列车定位方法 |
CN110395297B (zh) * | 2019-07-29 | 2021-08-10 | 兰州交通大学 | 列车定位方法 |
CN112937640A (zh) * | 2021-03-18 | 2021-06-11 | 北京交通大学 | 基于卫星定位环境场景误差特征的列车安全包络计算方法 |
CN112937640B (zh) * | 2021-03-18 | 2023-04-18 | 北京交通大学 | 基于卫星定位环境场景误差特征的列车安全包络计算方法 |
CN113581260A (zh) * | 2021-09-01 | 2021-11-02 | 兰州交通大学 | 一种基于gnss的列车轨道占用判别方法 |
CN113687396A (zh) * | 2021-09-26 | 2021-11-23 | 重庆赛迪奇智人工智能科技有限公司 | 定位处理方法、装置、定位设备、交通工具及存储介质 |
CN114348002A (zh) * | 2021-12-29 | 2022-04-15 | 江苏大学 | 一种轮毂电机驱动电动汽车的车速估计系统及方法 |
CN114440881A (zh) * | 2022-01-29 | 2022-05-06 | 海南大学 | 一种融合多源传感器信息的无人车定位方法 |
CN114440881B (zh) * | 2022-01-29 | 2023-05-30 | 海南大学 | 一种融合多源传感器信息的无人车定位方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108931799A (zh) | 基于递归快速正交搜索的列车组合定位方法及系统 | |
CN109211276B (zh) | 基于gpr与改进的srckf的sins初始对准方法 | |
CN109883426B (zh) | 基于因子图的动态分配与校正多源信息融合方法 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN112505737B (zh) | 一种gnss/ins组合导航方法 | |
CN111337020A (zh) | 引入抗差估计的因子图融合定位方法 | |
CN111156994A (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN102353378B (zh) | 一种矢量形式信息分配系数的组合导航系统自适应联邦滤波方法 | |
CN103439731A (zh) | 基于无迹卡尔曼滤波的gps/ins组合导航方法 | |
CN109507706B (zh) | 一种gps信号丢失的预测定位方法 | |
CN109506647B (zh) | 一种基于神经网络的ins和磁力计组合定位方法 | |
Nourmohammadi et al. | Design and experimental evaluation of indirect centralized and direct decentralized integration scheme for low-cost INS/GNSS system | |
Zhang et al. | A hybrid intelligent algorithm DGP-MLP for GNSS/INS integration during GNSS outages | |
CN110567455B (zh) | 一种求积更新容积卡尔曼滤波的紧组合导航方法 | |
CN103776449B (zh) | 一种提高鲁棒性的动基座初始对准方法 | |
CN102749633A (zh) | 一种卫星导航接收机的动态定位解算方法 | |
CN110395297B (zh) | 列车定位方法 | |
CN113175931A (zh) | 基于约束卡尔曼滤波的集群组网协同导航方法及系统 | |
Haidong | Neural network aided Kalman filtering for integrated GPS/INS navigation system | |
CN111190207A (zh) | 基于pstcsdref算法的无人机ins bds组合导航方法 | |
Gao et al. | A hybrid RISS/GNSS method during GNSS outage in the land vehicle navigation system | |
CN104280756A (zh) | 基于接收机钟差广义延拓逼近法的卫星定位增强方法 | |
Avzayesh et al. | Improved-Performance Vehicle’s State Estimator Under Uncertain Model Dynam | |
Wang et al. | An adaptive federated filter based on variational Bayes with application to multisource navigation | |
CN111290008A (zh) | 一种动态自适应扩展卡尔曼滤波容错算法 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20181204 |
|
RJ01 | Rejection of invention patent application after publication |