CN112710306A - 列车用bds与ins组合导航的自定位方法 - Google Patents
列车用bds与ins组合导航的自定位方法 Download PDFInfo
- Publication number
- CN112710306A CN112710306A CN202011522692.8A CN202011522692A CN112710306A CN 112710306 A CN112710306 A CN 112710306A CN 202011522692 A CN202011522692 A CN 202011522692A CN 112710306 A CN112710306 A CN 112710306A
- Authority
- CN
- China
- Prior art keywords
- unscented kalman
- kalman filtering
- filtering algorithm
- bds
- robust
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 55
- 238000001914 filtration Methods 0.000 claims abstract description 43
- 239000011159 matrix material Substances 0.000 claims abstract description 43
- 239000013598 vector Substances 0.000 claims abstract description 30
- 230000002159 abnormal effect Effects 0.000 claims abstract description 23
- 230000004927 fusion Effects 0.000 claims abstract description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 239000000126 substance Substances 0.000 claims description 4
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 230000002547 anomalous effect Effects 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims description 3
- 238000007689 inspection Methods 0.000 claims description 3
- 230000005856 abnormality Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000000342 Monte Carlo simulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000003137 locomotive effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000007704 transition Effects 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
- 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/20—Instruments for performing navigational calculations
-
- 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/393—Trajectory determination or predictive tracking, e.g. Kalman filtering
-
- 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)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及涉及BDS与INS组合导航的定位方法,具体为列车用BDS与INS组合导航的自定位方法。本发明为了解决当列车行驶至BDS信号容易受到干扰的地方时,列车导航定位精度低的问题,提供了一种改进的列车用BDS与INS组合导航定位方法,通过组合定位融合滤波器实现,组合定位融合滤波器采用无迹卡尔曼滤波算法+抗差无迹卡尔曼滤波算法,当BDS信号正常时,执行无迹卡尔曼滤波算法;当BDS信号异常时,执行抗差无迹卡尔曼滤波算法,抗差无迹卡尔曼滤波算法是在进行无迹卡尔曼滤波算法的过程中,将抗差因子引入无迹卡尔曼滤波算法以便更新新息向量协方差矩阵中,从而更新无迹卡尔曼滤波算法中的新息向量协方差矩阵提高了列车的定位精度。
Description
技术领域
本发明涉及BDS与INS组合导航技术领域,特别涉及BDS与INS组合导航的定位方法,具体为列车用BDS与INS组合导航的自定位方法。
背景技术
在列车运行控制系统中,获取列车精准定位是保障列车安全高效运行的重要保证。随着列车控制系统对于列车定位性能的要求不断增加,现有的定位设备均存在一定的缺点,例如北斗卫星导航系统(下文统称BDS)虽然能够提供全天候高精度定位信息,但是北斗卫星信号容易受到干扰而导致定位性能下降;惯性导航系统(下文统称INS)能够提供短期高精度定位结果,但是其存在定位结果误差随时间不断积累的问题,所以为了满足目前对列车定位性能的要求,使用不同定位设备进行组合导航定位成为列车导航的发展趋势,如现有技术中的BDS与INS组合导航定位方法,该方法中采用无迹卡尔曼滤波算法(UKF)进行定位,但是当列车行驶至BDS信号容易受到干扰的地方(如隧道)时,只能主要依靠INS信号,但是INS信号的误差会随时间不断增大,从而导致列车定位系统的精度降低,定位不准确,影响列车运营的安全性和运行效率。
发明内容
本发明为了解决当列车行驶至BDS信号容易受到干扰的地方时,采用现有的BDS与INS组合导航定位方法存在列车导航定位精度低的问题,提供了一种改进的列车用BDS与INS组合导航定位方法。
本发明是采用如下技术方案实现的:列车用BDS与INS组合导航的自定位方法,通过组合定位融合滤波器实现,组合定位融合滤波器采用无迹卡尔曼滤波算法+抗差无迹卡尔曼滤波算法,当BDS信号正常时,执行无迹卡尔曼滤波算法(无迹卡尔曼滤波算法是属于本领域技术人员的公知常识);当BDS信号异常时,执行抗差无迹卡尔曼滤波算法,所述抗差无迹卡尔曼滤波算法是在进行无迹卡尔曼滤波算法的过程中,将抗差因子引入无迹卡尔曼滤波算法的新息向量协方差矩阵中,从而更新无迹卡尔曼滤波算法中的新息向量协方差矩阵其中,计算抗差因子的具体步骤如下:
1)基于马氏距离建立北斗卫星信号异常观测的判别准则:
马氏距离是统计学中一种检测多元数据样本异常值的判别准则,对于一个均值为μ=(μ1,μ2,…,μp)T,协方差矩阵为Σ的多维向量x=(x1,x2,…,xp)T,其马氏距离定义为
为应用马氏距离判据辨识单目标跟踪系统中的异常观测,首先定义滤波器的新息向量为
因此,根据式(1)所描述的马氏距离定义,经过矩阵运算得到
故可建立如下的判别准则辨识系统的异常观测
将式(8)代入式(4),并构造如下非线性函数
令g(κk)=0,则抗差因子κk的确定变为求解非线性方程问题,采用牛顿迭代法求解该非线性方程,得到如下迭代表达式
式中,i表示第i次迭代,
将式(9)代入式(10),可得
根据矩阵求逆公式
得到
式中,M为关于t的可逆矩阵,
本发明所产生的有益效果如下:利用基于马氏距离判据的抗差无迹卡尔曼滤波算法,首先建立了一种基于马氏距离的异常观测辨识准则;然后,在此基础上进一步确定抗差因子,并将其引入无迹卡尔曼滤波算法的新息向量协方差矩阵中,以调整滤波增益,削弱异常观测对状态估计的影响。提出的算法可以抑制过程噪声方差不确定性对滤波解的影响,克服了无迹卡尔曼滤波算法的缺陷。基于马氏距离判据的抗差无迹卡尔曼滤波算法的非线性估计精度相比于无迹卡尔曼滤波算法的非线性估计精度,导航精度可至少提高45.5%。提升了铁路机车运营的安全性和运行效率。
附图说明
图1为UKF(无迹卡尔曼滤波算法)与抗差UKF(抗差无迹卡尔曼滤波算法)的x轴方向的速度误差对比;
图2为UKF(无迹卡尔曼滤波算法)与抗差UKF(抗差无迹卡尔曼滤波算法)的x轴方向的位置误差对比;
图3为UKF(无迹卡尔曼滤波算法)与抗差UKF(抗差无迹卡尔曼滤波算法)的y轴方向的速度误差对比;
图4为UKF(无迹卡尔曼滤波算法)与抗差UKF(抗差无迹卡尔曼滤波算法)的y轴方向的位置误差对比。
具体实施方式
列车用BDS与INS组合导航的自定位方法,具体步骤如下:
建立如下非线性高斯离散系统
Xk=Fk/k-1Xk-1+Wk (14)
Zk=h(Xk)+Vk (15)
式中,Xk∈Rn为k时刻系统的状态向量,Fk/k-1为离散状态转移矩阵,Zk∈Rm为k时刻系统的观测向量,h(·)为非线性观测函数即h(Xk),Wk和Vk为互不相关的零均值高斯白噪声过程,其方差满足
式中,Q为过程噪声矩阵,R为测量噪声矩阵。
针对(14)和(15)所描述的非线性高斯系统,在BDS信号良好的情况下,执行无迹卡尔曼滤波算法,将BDS数据与INS导航解算结果使用无迹卡尔曼滤波算法进行融合,对列车进行定位,具体计算步骤如下:
步骤2时间更新。由于系统的状态方程为非线性,则状态预测值及其误差协方差矩阵为
步骤4观测更新。式(20)选取的Sigma点经过非线性观测函数h(·)变换为
γi,k/k-1=h(ξi,k/k-1)(i=0,1,…,2n) (21)
计算观测预测值及其误差协方差矩阵
计算状态预测与观测预测间的互协方差矩阵
确定增益矩阵
步骤5重复步骤2-4,进行下一时刻滤波解算,直到处理完所有样本。
在BDS信号缺失的情况下,执行抗差无迹卡尔曼滤波算法,将抗差因子κk引入1)基于马氏距离建立北斗卫星信号异常观测的判别准则:
马氏距离是统计学中一种检测多元数据样本异常值的判别准则,对于一个均值为μ=(μ1,μ2,…,μp)T,协方差矩阵为Σ的多维向量x=(x1,x2,…,xp)T,其马氏距离定义为
为应用马氏距离判据辨识单目标跟踪系统中的异常观测,首先定义滤波器的新息向量为
因此,根据式(1)所描述的马氏距离定义,经过矩阵运算得到
故可建立如下的判别准则辨识系统的异常观测
将式(8)代入式(4),并构造如下非线性函数
令g(κk)=0,则抗差因子κk的确定变为求解非线性方程问题,采用牛顿迭代法求解该非线性方程,得到如下迭代表达式
式中,i表示第i次迭代,
将式(9)代入式(10),可得
根据矩阵求逆公式
得到
式中,M为关于t的可逆矩阵,
将提出的基于马氏距离判据的抗差无迹卡尔曼滤波算法应用于列车组合导航定位系统,进行Monte Carlo仿真实验,并与无迹卡尔曼滤波算法进行比较分析。Monte Carlo次数M=10。
假设系统的状态初值为
X0=[104m 65m/s 100m 20m/s]T (28)
滤波器的初始状态和初始误差协方差设置为
P0=2·I4 (30)
式中,I4表示4×4的单位阵。
Wk和Vk的协方差矩阵设置为
Q=diag(0,0.022,0,0.022),R=diag(52,0.0052) (31)
为了评估提出的抗差无迹卡尔曼滤波算法在系统存在观测异常时的估计性能,假设在[400s,600s]时间内,观测噪声协方差突然增大为原来的50倍,因此,真实的观测噪声协方差矩阵可描述为
图1—图4描绘了分别采用无迹卡尔曼滤波算法(UKF)和抗差无迹卡尔曼滤波算法(抗差UKF)得到的目标在x轴方向和y轴方向上的位置和速度误差。由图1—图4可以看出:
(i)在(0s,400s)和(600s,1000s)时间内,由于系统未引入异常观测信息(北斗卫星信号正常),因而UKF、抗差UKF均能够快速准确地估计列车的位置和速度信息,且两者的跟踪精度相当。
(ii)在[400s,600s]时间内,由于系统出现异常观测(北斗卫星信号异常),导致UKF的估计精度明显降低,而抗差UKF通过引入抗差因子调节滤波增益,显著提高了列车组合导航系统的估计精度,估计误差明显小于UKF。
表1给出了UKF和抗差UKF分别在[400s,600s]以及其他时间内得到的目标在x轴方向和y轴方向上位置和速度的平均绝对误差。表中的统计数据也充分证实了上述结论。
表1两种滤波算法得到的平均绝对误差对比
实验结果表明,当列车组合导航系统出现异常观测时,提出的抗差UKF的定位精度明显优于UKF,显著增强了滤波器的鲁棒性,从而提高了列车定位精度。
Claims (2)
1.列车用BDS与INS组合导航的自定位方法,其特征在于,通过组合定位融合滤波器实现,组合定位融合滤波器采用无迹卡尔曼滤波算法+抗差无迹卡尔曼滤波算法,当BDS信号正常时,执行无迹卡尔曼滤波算法;当BDS信号异常时,执行抗差无迹卡尔曼滤波算法,所述抗差无迹卡尔曼滤波算法是在进行无迹卡尔曼滤波算法的过程中,将抗差因子引入无迹卡尔曼滤波算法的新息向量协方差矩阵中,从而更新无迹卡尔曼滤波算法中的新息向量协方差矩阵其中,计算抗差因子的具体步骤如下:
1)基于马氏距离建立北斗卫星信号异常观测的判别准则:
马氏距离是统计学中一种检测多元数据样本异常值的判别准则,对于一个均值为μ=(μ1,μ2,…,μp)T,协方差矩阵为Σ的多维向量x=(x1,x2,…,xp)T,其马氏距离定义为
为应用马氏距离判据辨识单目标跟踪系统中的异常观测,首先定义滤波器的新息向量为
因此,根据式(1)所描述的马氏距离定义,经过矩阵运算得到
故可建立如下的判别准则辨识系统的异常观测
将式(8)代入式(4),并构造如下非线性函数
令g(κk)=0,则抗差因子κk的确定变为求解非线性方程问题。采用牛顿迭代法求解该非线性方程,得到如下迭代表达式
式中,i表示第i次迭代。
将式(9)代入式(10),可得
根据矩阵求逆公式
得到
式中,M为关于t的可逆矩阵,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011522692.8A CN112710306B (zh) | 2020-12-21 | 2020-12-21 | 列车用bds与ins组合导航的自定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011522692.8A CN112710306B (zh) | 2020-12-21 | 2020-12-21 | 列车用bds与ins组合导航的自定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112710306A true CN112710306A (zh) | 2021-04-27 |
CN112710306B CN112710306B (zh) | 2024-02-06 |
Family
ID=75544941
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011522692.8A Active CN112710306B (zh) | 2020-12-21 | 2020-12-21 | 列车用bds与ins组合导航的自定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112710306B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024003187A1 (fr) * | 2022-06-29 | 2024-01-04 | Torus Actions | Procédé de détermination de la position d'un dispositif à partir d'un réseau de satellites dans un système prédictif |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109211298A (zh) * | 2017-07-04 | 2019-01-15 | 百度在线网络技术(北京)有限公司 | 一种传感器标定方法和装置 |
CN110196443A (zh) * | 2019-06-06 | 2019-09-03 | 中国人民解放军战略支援部队信息工程大学 | 一种飞行器的容错组合导航方法及系统 |
CN110954132A (zh) * | 2019-10-31 | 2020-04-03 | 太原理工大学 | Grnn辅助自适应卡尔曼滤波进行导航故障识别的方法 |
-
2020
- 2020-12-21 CN CN202011522692.8A patent/CN112710306B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109211298A (zh) * | 2017-07-04 | 2019-01-15 | 百度在线网络技术(北京)有限公司 | 一种传感器标定方法和装置 |
CN110196443A (zh) * | 2019-06-06 | 2019-09-03 | 中国人民解放军战略支援部队信息工程大学 | 一种飞行器的容错组合导航方法及系统 |
CN110954132A (zh) * | 2019-10-31 | 2020-04-03 | 太原理工大学 | Grnn辅助自适应卡尔曼滤波进行导航故障识别的方法 |
Non-Patent Citations (1)
Title |
---|
王振杰;刘慧敏;杨慧良;贺凯飞;单瑞;: "基于垂直约束的深海拖曳系统USBL/DVL组合导航算法", 中国惯性技术学报, no. 05 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024003187A1 (fr) * | 2022-06-29 | 2024-01-04 | Torus Actions | Procédé de détermination de la position d'un dispositif à partir d'un réseau de satellites dans un système prédictif |
FR3137460A1 (fr) * | 2022-06-29 | 2024-01-05 | Torus Action | Procédé de détermination de la position d’un dispositif à partir d’un réseau de satellites dans un système prédictif |
FR3137450A1 (fr) * | 2022-06-29 | 2024-01-05 | Torus Actions | Procédé de détermination de la position d’un dispositif à partir d’un réseau de satellites dans un système prédictif |
Also Published As
Publication number | Publication date |
---|---|
CN112710306B (zh) | 2024-02-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111178385B (zh) | 一种鲁棒在线多传感器融合的目标跟踪方法 | |
CN112800616B (zh) | 基于比例加速退化建模的设备剩余寿命自适应预测方法 | |
EP2332017B1 (en) | Estimating a state of at least one target | |
CN109813342B (zh) | 一种惯导-卫星组合导航系统的故障检测方法和系统 | |
CN110161543B (zh) | 一种基于卡方检验的部分粗差抗差自适应滤波方法 | |
CN110287537B (zh) | 用于频标输出跳变检测的抗野值自适应卡尔曼滤波方法 | |
CN105115573A (zh) | 一种洪水流量预报的校正方法和装置 | |
US8949027B2 (en) | Multiple truth reference system and method | |
CN111259332B (zh) | 一种杂波环境下的模糊数据关联方法及多目标跟踪方法 | |
CN112710306A (zh) | 列车用bds与ins组合导航的自定位方法 | |
CN113391328A (zh) | 一种导航卫星系统自主进行卫星星历完好性监测的方法 | |
CN109656271B (zh) | 一种基于数据关联思想的航迹软关联方法 | |
CN106814608B (zh) | 基于后验概率分布的预测控制自适应滤波算法 | |
CN111090281B (zh) | 基于改进粒子滤波算法估算机器人方位的方法和装置 | |
CN112880659B (zh) | 一种基于信息概率的融合定位方法 | |
CN112581727B (zh) | 桥梁的位移漂移预警方法、装置、设备及存储介质 | |
CN115327525A (zh) | 航迹置信度的评估方法、装置及电子设备 | |
CN111444475B (zh) | 一种应用在飞行测试数据分析的容错ckf滤波融合方法 | |
WO2021181687A1 (ja) | 予測モデル作成装置、予測モデル作成方法及びプログラム | |
CN113761782A (zh) | 预测机台加工事件发生的方法与其虚拟量测应用 | |
CN113589239B (zh) | 一种雷达测量数据精度容错估计方法 | |
CN112581616B (zh) | 基于序贯分块滤波的最近邻ukf-slam方法 | |
CN116576890B (zh) | 基于集成神经网络的gnss/ins组合导航系统故障检测方法 | |
CN117674771B (zh) | 一种具有辨识噪声性能的抗差自适应滤波方法及其应用 | |
CN115342817B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |