CN107045125B - 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 - Google Patents
一种基于预测值量测转换的交互多模型雷达目标跟踪方法 Download PDFInfo
- Publication number
- CN107045125B CN107045125B CN201710159538.0A CN201710159538A CN107045125B CN 107045125 B CN107045125 B CN 107045125B CN 201710159538 A CN201710159538 A CN 201710159538A CN 107045125 B CN107045125 B CN 107045125B
- Authority
- CN
- China
- Prior art keywords
- measurement
- model
- calculating
- error
- target
- 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 title claims abstract description 66
- 238000006243 chemical reaction Methods 0.000 title claims abstract description 31
- 238000000034 method Methods 0.000 title claims abstract description 24
- 230000002452 interceptive effect Effects 0.000 title claims abstract description 12
- 239000011159 matrix material Substances 0.000 claims abstract description 27
- 230000009466 transformation Effects 0.000 claims abstract description 14
- 230000028161 membrane depolarization Effects 0.000 claims description 6
- 238000001914 filtration Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 2
- 230000007547 defect Effects 0.000 abstract description 4
- 238000004088 simulation Methods 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 5
- 238000000342 Monte Carlo simulation Methods 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
Images
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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明属于雷达目标跟踪领域,具体为一种基于预测值量测转换的交互多模型雷达目标跟踪方法。本发明在球坐标系下将基于预测值的量测转换协方差矩阵和以交互多模型为基础的卡尔曼滤波器相结合,实现机动目标跟踪。量测转换协方差所涉及的参数(包括估计的预测距离、方位角、俯仰角及相应估计的预测误差方差)根据滤波器获得的直角坐标系下估计的位置预测值和位置预测误差的协方差矩阵,再通过非线性变换和雅克比变换矩阵获得。克服了量测转换算法固有的缺陷,比EKF‑IMM追踪精度更高。
Description
技术领域
本发明属于雷达目标跟踪领域,特别涉及利用转换量测对机动目标跟踪的方法,具体为一种基于预测值量测转换的交互多模型雷达目标跟踪方法。
背景技术
在目标跟踪系统中,由于目标运动模型的不确定性,采用固定的系统状态方程无法描述机动目标的运动特性。交互多模型(IMM,interacting multiple model)算法,是一种解决基于运动模式未知情况下的机动目标追踪的有效方法(见文献:Blom,H.A.P,Anefficient filter for abruptly changing systems,InProceedingsof the 23rdIEEEConference on Decision and Control,Las Vegas,NV,Dec.1984,656-658.)。
在雷达目标跟踪中,目标的状态方程一般是建立在直角坐标系下的,而量测值一般是在极(球)坐标系下获得的。这样,目标跟踪就成为一个非线性估计问题。解决这一问题的常用方法是转换量测卡尔曼滤波(CMKF)算法,即使用转换量测方法将极(球)坐标下的量测变换表示成直角坐标系下的量测,从而使目标跟踪就成为一个线性估计问题。然而传统的转换量测的方法在转换量测时会产生偏差(见文献:Lerro.D,and Bar-Shalom.Y,Tracking With Debiased Consistent Converted Measurements Versus EKF,IEEETransactions on Aerospace and Electronic Systems,29,3(July 1993),1015-1022.)。如何去除转换量测值的偏差是提高雷达目标跟踪的精度的关键。
目前已有不少学者对此问题进行了研究,提出了一些改进方法,如去偏的转换量测卡尔曼滤波(CMKF-D)、无偏转换量测卡尔曼滤波(UCMKF)算法和修正的无偏转换量测卡尔曼滤波(MUCMKF)算法。CMKF-D算法求得的转换量测的偏差和协方差矩阵会引入附加的误差,因而不够精确。UCMKF算法中的无偏转换量测值是在真实值的条件下推导的,而转换量测误差的协方差矩阵在已获得的无偏转换量测值的基础上直接在量测值的条件下推导的,因此存在兼容性的问题。MUCMKF算法克服兼容性的问题,但是仅仅在量测值的条件下推导转换量测误差的均值和协方差矩阵,导致状态估计是有偏的。因此有了基于预测位置的去相关无偏量测转换卡尔曼滤波(Decorrelated Unbiased Converted Measurement KalmanFilter,DUCMKF)算法,该算法在计算转换量测误差的统计特性时,以直角坐标系下的位置预测值为条件获得转换量测误差的均值和协方差。消除了量测转换误差协方差与量测误差之间的相关性。
但是,现有的量测转换方法均未考虑被跟踪目标的机动特性。
发明内容
针对上述存在问题或不足,为解决现有量测转换方法均未考虑被跟踪目标的机动特性这一问题,本发明提供了一种基于预测值量测转换的交互多模型雷达目标跟踪方法。
具体技术方案如下:
设运动目标的模型个数为N,各模型初始概率模型转移概率矩阵为π。雷达采样周期为T,在k时刻获得的量测值分别为斜距量测rm、方位角量测αm和俯仰角量测θm,观测噪声为零均值高斯白噪声,其标准差分别为σr、σα和σθ。
步骤1、滤波器初始化
步骤2、计算混合概率
步骤3、计算每个滤波器输入的状态估计和误差自相关矩阵
步骤4、目标状态一步预测值
其中,
步骤5、一步预测误差自相关矩阵
式(5)的位置元素预测误差协方差分量设为
令目标真实斜距、方位角和俯仰角为r、α和θ,目标的量测值和真实值之间满足:
直角坐标系下转换量测分别为xm、ym和zm,真实值为x、y和z;
将球坐标系下的量测信息转换到直角坐标系有
量测转换误差为
对式(9)求期望可得极坐标系下量测转换均值
对转换量测进行去偏处理,得到去偏后的量测值为
步骤7、计算新息过程:
其中,H为量测矩阵;
步骤11、计算基于预测值的协方差矩阵Rducm(k)(j)
其中
同理求Ryy、Rzz、Rxy、Rxz和Ryz;
步骤12、计算新息过程自相关矩阵:
S(j)(k)=HP(j)(k|k-1)HΗ+Rducm(k)(j) (19)
步骤13、计算卡尔曼增益:
K(j)(k)=P(j)(k|k-1)HΗS(j)(k)-1 (20)
步骤14、概率更新
步骤15、模型j的目标状态估计和状态估计误差自相关矩阵
P(j)(k|k)=[I-K(j)(k)H]P(j)(k|k-1) (24)
步骤16、状态估计和状态误差自相关矩阵的组合
步骤17、重复步骤2-16进行递推滤波算法,实现目标跟踪。
本发明在球坐标系下将基于预测值的量测转换协方差矩阵和以交互多模型为基础的卡尔曼滤波器相结合,实现机动目标跟踪。量测转换协方差所涉及的参数(包括估计的预测距离、方位角、俯仰角及相应估计的预测误差方差)根据滤波器获得的直角坐标系下估计的位置预测值和位置预测误差的协方差矩阵,再通过非线性变换和雅克比变换矩阵获得。现考虑球坐标系下的雷达量测信息,极坐标系下情况类似。克服了量测转换算法固有的缺陷,比EKF-IMM追踪精度更高。
综上所述,本发明与现有的机动目标跟踪算法相比具有更高的跟踪精度。
附图说明
图1为实施例1在球坐标系下和基于传统量测的交互多模(CONV-IMM)的目标跟踪算法以及扩展卡尔曼滤波算法(EKF)对机动目标的跟踪精度RMSE仿真结果对比图;
图2为实施例2在球坐标系下和基于传统量测的交互多模(CONV-IMM)的目标跟踪算法以及扩展卡尔曼滤波算法(EKF)对机动目标的跟踪精度RMSE仿真结果对比图。
具体实施方式
在实施例中,考虑对球坐标2种目标运场景进行跟踪仿真。
在球坐标系下,传感器位于坐标原点,采样间隔为1s,匀速过程噪声为0.01,匀加速过程噪声为0.02,进行100次的蒙特卡洛仿真。初始值的设置:初始位置(50km,50km,80km),初始速度为(-100m/s,20m/s,0),1~70s内做匀速运动,70~100s做加速度为(1.5m/s2,0,1.5m/s2)的匀加速运动,100~150s做匀速运动。150~180s做加速度为(-1.5m/s2,0,-1.5m/s2)的匀加速运动,180~250s做匀速运动。
实施例1:传感器的距离量测误差为3m,方位角的量测误差为1度,俯仰角的量测误差为0.5度。
实施例2:传感器的距离量测误差为3m,方位角的量测误差为1.5度,俯仰角的量测误差为1.2度。
在上述2个实施例中,分别采用DUCM-IMM算法实现目标跟踪,并同时采用基于传统量测转换的交互多模型方法(CONV-IMM)以及EKF-IMM算法,比较其跟踪性能。所有算法在仿真过程使用了相同的目标初始状态及其估计误差协方差矩阵。目标跟踪性能指标为RMSE值,定义如下:
通过对上述仿真结果比较,可以发现:实施例1和实施例2对应的方位角量测误差由1度变至1.5度,俯仰角量测误差由0.5度变至1.2度,其他参数不变。在实施例1中,目标运动起始阶段CONV-IMM位置估计误差和DUCM-IMM位置估计误差接近。但趋于稳定后,CONV-IMM位置估计误差比DUCM-IMM估计误差大。EKF-IMM的RMES曲线收敛比较慢。在实施例2中,EKF-IMM的RMES曲线收敛慢,且估计误差较大。CONV-IMM位置估计误差比DUCM-IMM估计误差大,DUCM-IMM跟踪精度最高。
从所有仿真结果可以看出,本发明使用DUCM算法对机动目标进行量测值处理,可以提高追踪精度。由于传统量测转换会产生转换和估计偏差,CONV-IMM算法跟踪精度比DUCM-IMM算法差。EKF-IMM算法收敛速度最慢,这是因为扩展卡尔曼滤波算法线性处理过程中忽略了泰勒展开式的高阶项会导致发散现象。本发明利用预测值处理量测转换误差协方差,克服了量测转换算法固有的缺陷,比EKF-IMM追踪精度更高。
综上所述,可见本发明与现有的机动目标跟踪算法相比具有更高的跟踪精度。
Claims (1)
1.一种基于预测值量测转换的交互多模型雷达目标跟踪方法,具体包括以下步骤:
设运动目标的模型个数为N,各模型初始概率模型转移概率矩阵为π,雷达采样周期为T,在k时刻获得的量测值分别为斜距量测rm、方位角量测αm和俯仰角量测θm,观测噪声为零均值高斯白噪声,其标准差分别为σr、σα和σθ;
步骤1、滤波器初始化
步骤2、计算混合概率
步骤3、计算每个滤波器输入的状态估计和误差自相关矩阵
步骤4、目标状态一步预测值
步骤5、一步预测误差自相关矩阵
式(5)中位置元素预测误差协方差分量设为
令目标真实斜距、方位角和俯仰角为r、α和θ,目标的量测值和真实值之间满足:
直角坐标系下转换量测分别为xm、ym和zm,真实值为x、y和z;
将球坐标系下的量测信息转换到直角坐标系有
量测转换误差为
对转换量测进行去偏处理,得到去偏后的量测值为
步骤7、计算新息过程:
其中,H为量测矩阵;
步骤11、计算基于预测值的协方差矩阵Rducm(k)(j)
其中
同理求Ryy、Rzz、Rxy、Rxz和Ryz;
步骤12、计算新息过程自相关矩阵:
S(j)(k)=HP(j)(k|k-1)HH+Rducm(k)(j) (19)
步骤13、计算卡尔曼增益:
K(j)(k)=P(j)(k|k-1)HHS(j)(k)-1 (20)
步骤14、概率更新
其中,
步骤15、模型j的目标状态估计和状态估计误差自相关矩阵
P(j)(k|k)=[I-K(j)(k)H]P(j)(k|k-1) (24)
步骤16、状态估计和状态误差自相关矩阵的组合
步骤17、重复步骤2-16进行递推滤波算法,实现目标跟踪。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710159538.0A CN107045125B (zh) | 2017-03-17 | 2017-03-17 | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710159538.0A CN107045125B (zh) | 2017-03-17 | 2017-03-17 | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107045125A CN107045125A (zh) | 2017-08-15 |
CN107045125B true CN107045125B (zh) | 2020-01-14 |
Family
ID=59544162
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710159538.0A Expired - Fee Related CN107045125B (zh) | 2017-03-17 | 2017-03-17 | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107045125B (zh) |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107561503B (zh) * | 2017-08-28 | 2020-08-14 | 哈尔滨工业大学 | 一种基于多重渐消因子的自适应目标跟踪滤波方法 |
CN107703496B (zh) * | 2017-10-12 | 2021-04-30 | 桂林电子科技大学 | 一种交互式多模伯努利滤波的机动弱目标检测前跟踪方法 |
CN108226920B (zh) * | 2018-01-09 | 2021-07-06 | 电子科技大学 | 一种基于预测值处理多普勒量测的机动目标跟踪系统及方法 |
CN108710125A (zh) * | 2018-04-09 | 2018-10-26 | 西南民族大学 | 用于目标跟踪的距离方位滤波方法 |
CN108549062B (zh) * | 2018-04-28 | 2020-08-25 | 西安长远电子工程有限责任公司 | 一种用于海面搜索雷达的系统平台及多模型目标跟踪方法 |
CN108871365B (zh) * | 2018-07-06 | 2020-10-20 | 哈尔滨工业大学 | 一种航向约束下的状态估计方法及系统 |
CN109188422B (zh) * | 2018-08-08 | 2023-01-06 | 中国航空工业集团公司雷华电子技术研究所 | 一种基于lu分解的卡尔曼滤波目标跟踪方法 |
JP7084276B2 (ja) * | 2018-10-24 | 2022-06-14 | 株式会社Soken | 物体追跡装置 |
CN109655826B (zh) * | 2018-12-16 | 2021-06-08 | 成都汇蓉国科微系统技术有限公司 | 一种低慢小目标轨迹滤波方法及装置 |
CN109684771B (zh) * | 2019-01-11 | 2021-09-03 | 西安电子科技大学 | 基于交互式多模型的机动目标状态预测优化方法 |
CN110516193B (zh) * | 2019-07-08 | 2023-03-21 | 杭州电子科技大学 | 笛卡尔坐标系下基于转换瑞利滤波器的机动目标跟踪方法 |
CN110320511B (zh) * | 2019-07-11 | 2021-09-14 | 北京遥感设备研究所 | 一种基于全向搜索的航迹关联方法 |
CN110728026B (zh) * | 2019-09-16 | 2022-10-21 | 南京理工大学 | 一种基于角速度量测的末端弹道目标被动跟踪方法 |
CN110716196B (zh) * | 2019-11-04 | 2023-04-25 | 广东中科四创科技有限公司 | 一种多点低慢小空中目标跟踪临视方法 |
CN111190173B (zh) * | 2020-01-14 | 2023-02-14 | 电子科技大学 | 一种基于预测值量测转换的相控阵雷达目标跟踪方法 |
CN111624594B (zh) * | 2020-05-12 | 2022-09-23 | 中国电子科技集团公司第三十八研究所 | 一种基于转换量测重构的组网雷达跟踪方法及系统 |
CN111650577B (zh) * | 2020-06-12 | 2022-05-24 | 电子科技大学 | 极坐标系下含多普勒量测的机动目标跟踪方法 |
TWI739479B (zh) * | 2020-06-17 | 2021-09-11 | 廣達電腦股份有限公司 | 用於提升定位的平滑度與精準度的電子裝置及定位方法 |
CN113534128B (zh) * | 2020-10-21 | 2022-10-11 | 中国人民解放军空军预警学院 | 一种机载预警雷达海面机动舰船目标自适应跟踪方法 |
CN113009468B (zh) * | 2021-02-26 | 2023-05-26 | 中国电子科技集团公司第三十八研究所 | 一种视线坐标系内的解耦cmkf跟踪方法及系统 |
CN113376626A (zh) * | 2021-06-23 | 2021-09-10 | 西安电子科技大学 | 基于immpda算法的高机动目标跟踪方法 |
CN114114240B (zh) * | 2021-11-03 | 2024-02-27 | 中国电子科技集团公司信息科学研究院 | 超稀疏阵列在栅瓣影响下的三维目标跟踪方法和装置 |
CN114488116B (zh) * | 2022-01-17 | 2024-04-26 | 武汉大学 | 一种基于两部两坐标外源雷达系统的3d目标跟踪方法 |
CN115128597B (zh) * | 2022-08-25 | 2022-11-25 | 西安电子科技大学 | 基于imm-stekf的非高斯噪声下机动目标跟踪方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104035083A (zh) * | 2014-06-20 | 2014-09-10 | 电子科技大学 | 一种基于量测转换的雷达目标跟踪方法 |
CN104182609A (zh) * | 2014-07-17 | 2014-12-03 | 电子科技大学 | 基于去相关的无偏转换量测的三维目标跟踪方法 |
CN106054170A (zh) * | 2016-05-19 | 2016-10-26 | 哈尔滨工业大学 | 一种约束条件下的机动目标跟踪方法 |
-
2017
- 2017-03-17 CN CN201710159538.0A patent/CN107045125B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104035083A (zh) * | 2014-06-20 | 2014-09-10 | 电子科技大学 | 一种基于量测转换的雷达目标跟踪方法 |
CN104182609A (zh) * | 2014-07-17 | 2014-12-03 | 电子科技大学 | 基于去相关的无偏转换量测的三维目标跟踪方法 |
CN106054170A (zh) * | 2016-05-19 | 2016-10-26 | 哈尔滨工业大学 | 一种约束条件下的机动目标跟踪方法 |
Non-Patent Citations (2)
Title |
---|
Tracking with debiased consistent converted measurements versus EKF;D. Lerro et al.;《IEEE Transactions on Aerospace and Electronic Systems》;19930731;第29卷(第3期);1015 - 1022 * |
基于极坐标多普勒伪状态的最佳线性无偏估计算法;荣里 等;《火力与指挥控制》;20170131;第42卷(第1期);146-149,153 * |
Also Published As
Publication number | Publication date |
---|---|
CN107045125A (zh) | 2017-08-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107045125B (zh) | 一种基于预测值量测转换的交互多模型雷达目标跟踪方法 | |
CN108226920B (zh) | 一种基于预测值处理多普勒量测的机动目标跟踪系统及方法 | |
CN111985093B (zh) | 一种带噪声估计器的自适应无迹卡尔曼滤波状态估计方法 | |
CN109508445B (zh) | 一种带有色量测噪声和变分贝叶斯自适应卡尔曼滤波的目标跟踪方法 | |
CN106950562B (zh) | 一种基于预测值量测转换的状态融合目标跟踪方法 | |
CN106443661B (zh) | 基于无迹卡尔曼滤波的机动扩展目标跟踪方法 | |
CN108896986B (zh) | 一种基于预测值的量测转换序贯滤波机动目标跟踪方法 | |
CN104035083B (zh) | 一种基于量测转换的雷达目标跟踪方法 | |
CN110208792B (zh) | 同时估计目标状态和轨迹参数的任意直线约束跟踪方法 | |
CN108802721B (zh) | 一种任意直线约束下目标跟踪方法 | |
Mallick et al. | Comparison of nonlinear filtering algorithms in ground moving target indicator (GMTI) tracking | |
CN103383261A (zh) | 一种改进型无损卡尔曼滤波室内动目标定位方法 | |
CN109001699B (zh) | 基于带噪声目的地信息约束的跟踪方法 | |
CN110209180B (zh) | 一种基于HuberM-Cubature卡尔曼滤波的无人水下航行器目标跟踪方法 | |
CN110231620B (zh) | 一种噪声相关系统跟踪滤波方法 | |
CN108871365B (zh) | 一种航向约束下的状态估计方法及系统 | |
CN115204212A (zh) | 一种基于stm-pmbm滤波算法的多目标跟踪方法 | |
CN112034445A (zh) | 基于毫米波雷达的车辆运动轨迹跟踪方法和系统 | |
CN112328959A (zh) | 一种基于自适应扩展卡尔曼概率假设密度滤波器的多目标跟踪方法 | |
CN104777465B (zh) | 基于b样条函数任意扩展目标形状及状态估计方法 | |
CN109239704B (zh) | 一种基于序贯滤波交互式多模型的自适应采样方法 | |
CN113344970A (zh) | 基于多伯努利的非规则多扩展目标联合跟踪与分类方法 | |
CN116224320B (zh) | 一种极坐标系下处理多普勒量测的雷达目标跟踪方法 | |
CN104849697B (zh) | 一种基于去偏坐标转换的α‑β滤波方法 | |
CN112835020B (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200114 |