CN105353352B - 改进搜索策略的mm‑pphdf机动多目标跟踪方法 - Google Patents

改进搜索策略的mm‑pphdf机动多目标跟踪方法 Download PDF

Info

Publication number
CN105353352B
CN105353352B CN201510791331.6A CN201510791331A CN105353352B CN 105353352 B CN105353352 B CN 105353352B CN 201510791331 A CN201510791331 A CN 201510791331A CN 105353352 B CN105353352 B CN 105353352B
Authority
CN
China
Prior art keywords
mrow
mtd
msubsup
msub
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.)
Active
Application number
CN201510791331.6A
Other languages
English (en)
Other versions
CN105353352A (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.)
Naval Aeronautical University
Original Assignee
Naval Aeronautical Engineering Institute of PLA
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 Naval Aeronautical Engineering Institute of PLA filed Critical Naval Aeronautical Engineering Institute of PLA
Priority to CN201510791331.6A priority Critical patent/CN105353352B/zh
Publication of CN105353352A publication Critical patent/CN105353352A/zh
Application granted granted Critical
Publication of CN105353352B publication Critical patent/CN105353352B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • 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
    • G01S13/00Systems 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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/52Discriminating between fixed and moving objects or between objects moving at different speeds
    • G01S13/56Discriminating between fixed and moving objects or between objects moving at different speeds for presence detection
    • 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
    • G01S13/00Systems 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/66Radar-tracking systems; Analogous systems

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)
  • Other Investigation Or Analysis Of Materials By Electrical Means (AREA)

Abstract

本发明公开了一种改进搜索策略的MM‑PPHDF机动多目标跟踪方法,属于雷达数据处理领域。基于MM‑PPHDF的机动多目标跟踪方法存在一个明显的缺陷,即当目标出现漏检时,重采样会造成粒子多样性的迅速退化,进而造成目标丢失的现象,因此该算法难以适应目标检测概率较低时的机动多目标跟踪。本发明提出的改进搜索策略的MM‑PPHDF机动多目标跟踪方法立足于解决此类问题。本发明具有结构简单,计算快速,对强非线性非高斯系统具有良好的适应性等优点,实施例的实验仿真结果也表明本发明可以有效克服基于MM‑PPHDF方法应用的局限性,因此本发明公开的改进搜索策略的MM‑PPHDF机动多目标跟踪方法具有较强的工程应用价值和推广前景。

Description

改进搜索策略的MM-PPHDF机动多目标跟踪方法
技术领域
本发明涉及一种雷达数据处理方法,特别是涉及一种低检测概率情况下雷达对机动多目标的跟踪方法。
背景技术
电磁环境的日益复杂和各类飞行器的大量出现,给雷达的检测跟踪性能带来了严峻的挑战。同时,为了提高生存和突防能力,目标通常会随时进行一定的机动,其运动状态也会因不同的作战任务而变,进一步增大了雷达对其进行跟踪的困难。因此,实现复杂电磁环境下雷达对机动多目标的有效跟踪,对提高雷达作战效能和生存能力具有重要意义。目前基于粒子概率假设密度滤波(PPHDF)的多目标跟踪方法通过将量测和目标状态建模为随机集,可以在避免目标和量测之间的关联问题的同时对目标个数和目标状态进行估计,极大的降低了多目标跟踪算法的复杂性和计算量,因此在多目标跟踪领域得到广泛的关注,而PPHDF通过借鉴多模型粒子滤波(MMPF)的思想,形成了一种基于多模型粒子概率假设密度滤波(MM-PPHDF)的机动多目标跟踪方法。该方法主要通过以下步骤实现:
(1)将雷达接收机输出的目标回波信号进行A/D变换,送雷达数据处理计算机执行以下步骤;
(2)对目标运动模式进行预测,并利用预测的目标运动模式和相应的目标状态转移方程对已存在的粒子集进行预测;
(3)生成用于搜索新目标的搜索粒子集,将预测粒子集和搜索粒子集合成新的预测粒子集;
(4)利用新量测对预测粒子集粒子权重进行更新;
(5)对权重更新后的粒子集进行重采样,并得到目标个数和各目标状态估计。
基于MM-PPHDF的机动多目标跟踪方法存在一个比较明显的缺陷,即当目标出现漏检时,重采样会造成粒子多样性的迅速退化,进而造成目标丢失的现象。因此,该算法难以适应目标检测概率较低时的机动多目标跟踪。
发明内容
本发明的目的是提出一种改进搜索策略的MM-PPHDF机动多目标跟踪方法,解决一般的MM-PPHDF方法在检测概率较低情况下容易出现目标丢失的问题。
本发明提出的改进搜索策略的MM-PPHDF机动多目标跟踪方法的技术方案包括以下步骤:
步骤1:变量初始化
K是雷达关机时刻;
T是雷达扫描周期;
L0为代表1个目标的粒子数;
D0为目标出现的初始分布;
Jk为搜索新目标的粒子数;
Sk表示搜索1个消失目标的粒子数;
Lk为k时刻滤波器采用的粒子总数;
γk为平均目标出现概率;
PD为目标检测概率;
λk为平均每帧的杂波个数;
为k时刻估计的目标个数;
是目标初始运动模式概率;
m是目标运动模式概率转移矩阵;
为状态转移矩阵;
Gk为过程噪声分布矩阵;
Qk为过程噪声协方差;
Rk为量测噪声协方差;
步骤2:初始化粒子集,令k=0和对任意p∈{1,2,…,L0}
(1)根据目标初始运动模式概率初始化目标运动模式变量
(2)从初始分布D0中采样粒子其中表示粒子代表的目标状态,包含了目标的位置和速度信息;
(3)赋予粒子权重
步骤3:令k=k+1,获得k时刻的雷达量测
将雷达接收到的信号进行A/D变换,得到k时刻的雷达量测集送雷达数据处理计算机,其中表示k时刻雷达得到的第q个量测,包含了目标的距离量测多普勒速度量测以及方位量测等信息,而Mk则表示k时刻雷达得到的量测个数;
步骤4:已存在粒子集预测,若直接转步骤5,否则对任意p∈{1,2,…,Lk-1}
(1)根据上一时刻的目标运动模式变量和目标运动模式概率转移矩阵∏m预测当前时刻的目标运动模式变量
(2)根据选择目标状态状态转移矩阵,其中
对应于目标匀速直线运动
对应于目标坐标转动,其中
分别对应于顺时针坐标转动和逆时针坐标转动,αm>0是一个典型的机动加速度;
(3)利用粒子的状态进行一步预测
得到粒子其中
为过程噪声分布矩阵,vk为过程噪声,其噪声协方差为Qk
(4)赋予粒子权重
步骤5:生成搜索新目标的粒子集,对任意p∈{Lk-1+Ik+1,…,Lk-1+Ik+Jk}
(1)根据目标初始运动模式概率初始化目标运动模式变量
(2)根据初始分布D0采样“新生”粒子
(3)赋予粒子权重
步骤6:生成消失目标预测粒子集
(1)若k≤2,令Ik=0,直接转步骤7,否则定义集合
其中,表示k-2时刻存在而k-1时刻消失的第n个目标的状态,Ndis,k-1表示消失的目标数;
(2)若令Ik=0,直接转步骤7,否则令Ik=Ndis,k-1Sk,对任意根据估计的目标运动模式和相应的状态转移方程进行一步预测
(3)对任意n∈{1,2,…,Ndis,k-1}和任意p∈{Lk-1+(n-1)Sk+1,…,Lk-1+nSk},令利用进行一步预测
得到粒子并赋予该粒子权重
步骤7:更新
对任意p∈{1,2,…,Lk-1+Ik+Jk},利用量测集Zk对粒子权重进行更新
其中
gk(z|x)为量测似然函数;
步骤8:重采样
(1)计算所有粒子的权重和
(2)对粒子集进行重采样,得到新的粒子集其中Round(x)表示取与x最接近的整数;步骤9:目标状态和运动模式估计
(1)若直接转步骤10,否则采用聚类分析的方法将粒子集划分为个类其中Lk,n表示第n个类包含的粒子数,满足
(2)估计目标状态
(3)估计目标的运动模式
其中函数表示集合中元素m的个数;
步骤10:重复步骤3~步骤8,直至雷达关机。
和背景技术相比,本发明的有益效果说明:
本发明提出的改进搜索策略的MM-PPHDF多目标跟踪方法,可以解决一般的MM-PPHDF方法在目标检测概率较低的情况下容易出现目标丢失的问题,提高了MM-PPHDF算法的适应范围。
附图说明
附图1是本发明提出的改进搜索策略的MM-PPHDF机动多目标跟踪方法的整体流程图;
附图2是本发明实施例中三个机动目标的真实轨迹示意图;
附图3是本发明实施例中改进搜索策略的MM-PPHDF方法跟踪机动多目标的效果展示,附图中星号“*”表示目标的真实位置,圆圈“o”表示估计的目标状态;
附图4是本发明实施例中一般的MM-PPHDF方法跟踪机动多目标的效果展示,附图中星号“*”表示目标的真实位置,圆圈“o”表示估计的目标状态。
具体实施方式
下面结合附图对本发明提出的改进搜索策略的MM-PPHDF方法进行详细描述。
不失一般性,设置一个二维的仿真场景,监测区域S=[-60km,60km]×[-60km,60km],总仿真时间K=50s。假设目标都服从以下3种运动模型中的一种:匀速直线运动模式,顺时针坐标转动模式和逆时针坐标转动模式,目标初始运动模式概率 可在3种运动模式之间自由转换,各种运动模型之间的转换可描述为3态的1阶Markov链,模式概率转移矩阵
机动加速度αm=1.08。目标可在监测区域内随机出现和消失,平均目标出现概率γk=0.2,目标出现的初始分布D0服从均值为x0和协方差为Qb的正态分布,这里取x0=[30km0.2km/s 30km-0.1km/s]T和Qb=diag([1km 0.5km/s 1km 0.5km/s]),x方向和y方向过程噪声的标准差均为0.01km,目标持续存在的概率为ek|k-1=0.95且与目标状态无关。雷达位于点(0km,-10km),检测概率为PD=0.75,平均每帧的杂波个数为λk=4,且在整个监测区域内均匀分布,距离量测误差标准差、多普勒速度量测误差标准差和方位角量测误差标准差分别为0.2km、0.04km/s和0.0087rad,雷达采样间隔T=1s;代表1个目标的粒子数L0=3000,搜索新目标的粒子数Jk=4000,搜索1个消失目标的粒子数Sk=1000。
其步骤如附图1所示。
(1)根据以上仿真条件进行变量初始化
状态转移矩阵、过程噪声分布矩阵和过程噪声协方差分别
雷达量测方程为
其中Wk为相互独立的零均值高斯白噪声,其协方差为
(2)按发明内容部分步骤2所述的方法进行粒子集初始化;
(3)按发明内容部分步骤3所述的方法获得当前时刻雷达量测;
(4)按发明内容部分步骤4所述的方法对已存在粒子集进行一步预测;
(5)按发明内容部分步骤5所述的方法生成搜索新目标的粒子集;
(6)按发明内容部分步骤6所述的方法生成消失目标预测粒子集;
(7)按发明内容部分步骤7所述的方法对预测粒子集进行权重更新;
(8)按发明内容部分步骤8所述的方法对权重更新后的粒子集进行重采样,得到目标个数估计;
(9)按发明内容部分步骤9所述的方法得到目标的状态和运动模式估计;
(10)循环执行发明内容部分步骤3~步骤8,直至雷达关机。
实施例条件中,在目标检测概率PD=0.75的情况下,本发明提出的改进搜索策略的MM-PPHDF方法仍能实现杂波环境下对机动多目标的有效跟踪(见附图3),而MM-PPHDF方法一开始可以检测到目标存在,但是当雷达出现漏检时随即丢失目标(见附图4),因此本发明方法可以明显改善MM-PPHDF方法在目标检测概率较低情况下的多机动目标跟踪性能(附图3和附图4对比)。

Claims (1)

1.改进搜索策略的MM-PPHDF机动多目标跟踪方法,其特征在于,包括以下步骤:
步骤1,变量初始化:
K是雷达关机时刻;
T是雷达扫描周期;
L0为代表1个目标的粒子数;
D0为目标出现的初始分布;
Jk为搜索新目标的粒子数;
Sk表示搜索1个消失目标的粒子数;
Ik为搜索消失目标的粒子数,初始值为零;
Lk为k时刻滤波器采用的粒子总数;
γk为平均目标出现概率;
PD为目标检测概率;
λk为平均每帧的杂波个数;
为k时刻估计的目标个数;
是目标初始运动模式概率;
m是目标运动模式概率转移矩阵;
为状态转移矩阵;
Gk为过程噪声分布矩阵;
Qk为过程噪声协方差;
Rk为量测噪声协方差;
步骤2,初始化粒子集,令k=0和对任意p∈{1,2,…,L0}:
(1)根据目标初始运动模式概率初始化目标运动模式变量
(2)从初始分布D0中采样粒子其中表示粒子代表的目标状态,包含了目标的位置和速度信息;
(3)赋予粒子权重
步骤3,令k=k+1,获得k时刻的雷达量测:
将雷达接收到的信号进行A/D变换,得到k时刻的雷达量测集送雷达数据处理计算机,其中表示k时刻雷达得到的第q个量测,包含了目标的距离量测多普勒速度量测以及方位量测信息,而Mk则表示k时刻雷达得到的量测个数;
步骤4,已存在粒子集预测,若直接转步骤5,否则对任意p∈{1,2,…,Lk-1}:
(1)根据上一时刻的目标运动模式变量和目标运动模式概率转移矩阵Πm预测当前时刻的目标运动模式变量
(2)根据选择目标状态状态转移矩阵,其中
<mrow> <msubsup> <mi>F</mi> <mi>k</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mi>T</mi> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mi>T</mi> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> </mrow>
对应于目标匀速直线运动
<mrow> <msubsup> <mi>F</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mfrac> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mi>sin</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> </mfrac> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mfrac> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> </mfrac> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </msubsup> <mi>T</mi> </mrow> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mi>j</mi> <mo>=</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> </mrow>
对应于目标坐标转动,其中
<mrow> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <mfrac> <mrow> <mo>-</mo> <msub> <mi>&amp;alpha;</mi> <mi>m</mi> </msub> </mrow> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msubsup> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mover> <mi>y</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>,</mo> <msubsup> <mi>&amp;Omega;</mi> <mi>k</mi> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <mfrac> <msub> <mi>&amp;alpha;</mi> <mi>m</mi> </msub> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msubsup> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msubsup> <mover> <mi>y</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> </mrow>
分别对应于顺时针坐标转动和逆时针坐标转动,αm>0是一个典型的机动加速度;
(3)利用粒子的状态进行一步预测
<mrow> <msubsup> <mi>x</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <msubsup> <mi>F</mi> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mrow> <mo>(</mo> <msubsup> <mi>m</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> </msubsup> <msubsup> <mi>x</mi> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>+</mo> <msub> <mi>G</mi> <mi>k</mi> </msub> <msub> <mi>v</mi> <mi>k</mi> </msub> </mrow>
得到粒子其中
<mrow> <msub> <mi>G</mi> <mi>k</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msup> <mi>T</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mi>T</mi> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <msup> <mi>T</mi> <mn>2</mn> </msup> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mi>T</mi> </mtd> </mtr> </mtable> </mfenced> </mrow>
为过程噪声分布矩阵,vk为过程噪声,其噪声协方差为Qk
(4)赋予粒子权重
步骤5,生成搜索新目标的粒子集,对任意p∈{Lk-1+Ik+1,Lk-1+Ik+2,…,Lk-1+Ik+Jk}:
(1)根据目标初始运动模式概率初始化目标运动模式变量
(2)根据初始分布D0采样“新生”粒子
(3)赋予粒子权重
步骤6,生成消失目标预测粒子集:
(1)若k≤2,令Ik=0,直接转步骤7,否则定义集合
<mrow> <msub> <mi>X</mi> <mrow> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>,</mo> <mi>k</mi> <mo>-</mo> <mn>2</mn> </mrow> </msub> <mover> <mo>=</mo> <mi>&amp;Delta;</mi> </mover> <mo>{</mo> <msubsup> <mi>x</mi> <mrow> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>,</mo> <mi>k</mi> <mo>-</mo> <mn>2</mn> </mrow> <mi>n</mi> </msubsup> <mo>|</mo> <mi>n</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mo>...</mo> <mo>,</mo> <msub> <mi>N</mi> <mrow> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>,</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>}</mo> </mrow>
其中,表示k-2时刻存在而k-1时刻消失的第n个目标的状态,Ndis,k-1表示消失的目标数;
(2)若令Ik=0,直接转步骤7,否则令Ik=Ndis,k-1Sk,对任意根据估计的目标运动模式和相应的状态转移方程进行一步预测
<mrow> <msubsup> <mi>x</mi> <mrow> <mi>p</mi> <mi>r</mi> <mi>e</mi> <mo>,</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>n</mi> </msubsup> <mo>=</mo> <msubsup> <mi>F</mi> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mrow> <mo>(</mo> <msub> <mover> <mi>m</mi> <mo>^</mo> </mover> <mrow> <mi>k</mi> <mo>-</mo> <mn>2</mn> <mo>,</mo> <mi>n</mi> </mrow> </msub> <mo>)</mo> </mrow> </msubsup> <msubsup> <mi>x</mi> <mrow> <mi>d</mi> <mi>i</mi> <mi>s</mi> <mo>,</mo> <mi>k</mi> <mo>-</mo> <mn>2</mn> </mrow> <mi>n</mi> </msubsup> </mrow>
(3)对任意n∈{1,2,...,Ndis,k-1}和任意p∈{Lk-1+(n-1)Sk+1,Lk-1+(n-1)Sk+2,…,Lk-1+nSk},令利用进行一步预测
<mrow> <msubsup> <mi>x</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <msubsup> <mi>F</mi> <mi>k</mi> <mrow> <mo>(</mo> <msubsup> <mi>m</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> </msubsup> <msubsup> <mi>x</mi> <mrow> <mi>p</mi> <mi>r</mi> <mi>e</mi> <mo>,</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>n</mi> </msubsup> <mo>+</mo> <msub> <mi>G</mi> <mi>k</mi> </msub> <msub> <mi>v</mi> <mi>k</mi> </msub> </mrow>
得到粒子并赋予该粒子权重
步骤7,更新:
对任意p∈{1,2,…,Lk-1+Ik+Jk},利用量测集Zk对粒子权重进行更新
<mrow> <msubsup> <mi>w</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> </mrow> <mi>p</mi> </msubsup> <mo>=</mo> <mo>&amp;lsqb;</mo> <mn>1</mn> <mo>-</mo> <msub> <mi>P</mi> <mi>D</mi> </msub> <mo>+</mo> <munder> <mo>&amp;Sigma;</mo> <mrow> <mi>z</mi> <mo>&amp;Element;</mo> <msub> <mi>Z</mi> <mi>k</mi> </msub> </mrow> </munder> <mfrac> <mrow> <msub> <mi>&amp;psi;</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>z</mi> </mrow> </msub> <mrow> <mo>(</mo> <msubsup> <mi>x</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>&amp;lambda;</mi> <mi>k</mi> </msub> <mo>+</mo> <msub> <mi>C</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>z</mi> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>&amp;rsqb;</mo> <msubsup> <mi>w</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> </mrow>
其中
<mrow> <msub> <mi>&amp;psi;</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>z</mi> </mrow> </msub> <mrow> <mo>(</mo> <msubsup> <mi>x</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>P</mi> <mi>D</mi> </msub> <msub> <mi>g</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>z</mi> <mo>|</mo> <msubsup> <mi>x</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>C</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>z</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>p</mi> <mo>=</mo> <mn>1</mn> </mrow> <mrow> <msub> <mi>L</mi> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>I</mi> <mi>k</mi> </msub> <mo>+</mo> <msub> <mi>J</mi> <mi>k</mi> </msub> </mrow> </munderover> <msub> <mi>&amp;psi;</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>z</mi> </mrow> </msub> <mrow> <mo>(</mo> <msubsup> <mi>x</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> <mo>)</mo> </mrow> <msubsup> <mi>w</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mi>p</mi> </msubsup> </mrow>
gk(z|x)为量测似然函数;
步骤8,重采样:
(1)计算所有粒子的权重和
<mrow> <msub> <mover> <mi>N</mi> <mo>^</mo> </mover> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> </mrow> </msub> <mo>=</mo> <msubsup> <mi>&amp;Sigma;</mi> <mrow> <mi>p</mi> <mo>=</mo> <mn>1</mn> </mrow> <mrow> <msub> <mi>L</mi> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>I</mi> <mi>k</mi> </msub> <mo>+</mo> <msub> <mi>J</mi> <mi>k</mi> </msub> </mrow> </msubsup> <msubsup> <mi>w</mi> <mrow> <mi>k</mi> <mo>|</mo> <mi>k</mi> </mrow> <mi>p</mi> </msubsup> </mrow>
(2)对粒子集进行重采样,得到新的粒子集其中Round(x)表示取与x最接近的整数;步骤9,目标状态和运动模式估计:
(1)若直接转步骤10,否则采用聚类分析的方法将粒子集划分为个类其中Lk,n表示第n个类包含的粒子数,满足
(2)估计目标状态
<mrow> <msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mi>k</mi> <mo>,</mo> <mi>n</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <msub> <mi>L</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>n</mi> </mrow> </msub> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>p</mi> <mo>=</mo> <mn>1</mn> </mrow> <msub> <mi>L</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>n</mi> </mrow> </msub> </munderover> <msubsup> <msup> <mi>x</mi> <mo>&amp;prime;</mo> </msup> <mrow> <mi>k</mi> <mo>,</mo> <mi>n</mi> </mrow> <mi>p</mi> </msubsup> <mo>,</mo> <mi>n</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mo>...</mo> <mo>,</mo> <msub> <mover> <mi>N</mi> <mo>^</mo> </mover> <mi>k</mi> </msub> </mrow>
(3)估计目标的运动模式
<mrow> <msub> <mover> <mi>m</mi> <mo>^</mo> </mover> <mrow> <mi>k</mi> <mo>,</mo> <mi>n</mi> </mrow> </msub> <mo>=</mo> <munder> <mi>arg</mi> <mi>m</mi> </munder> <mi>m</mi> <mi>a</mi> <mi>x</mi> <mo>&amp;lsqb;</mo> <mi>N</mi> <mi>u</mi> <mi>m</mi> <mrow> <mo>(</mo> <msubsup> <mrow> <mo>{</mo> <msubsup> <mi>m</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>n</mi> </mrow> <mrow> <mo>&amp;prime;</mo> <mi>p</mi> </mrow> </msubsup> <mo>}</mo> </mrow> <mrow> <mi>p</mi> <mo>=</mo> <mn>1</mn> </mrow> <msub> <mi>L</mi> <mrow> <mi>k</mi> <mo>,</mo> <mi>n</mi> </mrow> </msub> </msubsup> <mo>,</mo> <mi>m</mi> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> </mrow>
其中函数表示集合中元素m的个数;
步骤10,重复步骤3~步骤9,直至雷达关机。
CN201510791331.6A 2015-11-17 2015-11-17 改进搜索策略的mm‑pphdf机动多目标跟踪方法 Active CN105353352B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510791331.6A CN105353352B (zh) 2015-11-17 2015-11-17 改进搜索策略的mm‑pphdf机动多目标跟踪方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510791331.6A CN105353352B (zh) 2015-11-17 2015-11-17 改进搜索策略的mm‑pphdf机动多目标跟踪方法

Publications (2)

Publication Number Publication Date
CN105353352A CN105353352A (zh) 2016-02-24
CN105353352B true CN105353352B (zh) 2017-08-25

Family

ID=55329353

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510791331.6A Active CN105353352B (zh) 2015-11-17 2015-11-17 改进搜索策略的mm‑pphdf机动多目标跟踪方法

Country Status (1)

Country Link
CN (1) CN105353352B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107037423A (zh) * 2016-11-09 2017-08-11 谭顺成 结合幅值信息的phd滤波多目标跟踪方法
CN106772357B (zh) * 2016-11-23 2019-01-29 谭顺成 信噪比未知条件下的ai-phd滤波器多目标跟踪方法
CN107703496B (zh) * 2017-10-12 2021-04-30 桂林电子科技大学 一种交互式多模伯努利滤波的机动弱目标检测前跟踪方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101980044B (zh) * 2010-01-22 2012-10-17 西安电子科技大学 未知测量噪声分布下的多目标跟踪方法
CN103902819A (zh) * 2014-03-21 2014-07-02 哈尔滨工程大学 基于变分滤波的粒子优化概率假设密度多目标跟踪方法
CN104019816A (zh) * 2014-05-30 2014-09-03 西北工业大学 基于全局时空相关的概率假设密度滤波器航迹提取方法

Also Published As

Publication number Publication date
CN105353352A (zh) 2016-02-24

Similar Documents

Publication Publication Date Title
CN105301584B (zh) 同时解距离模糊的ipphdf机动多目标跟踪方法
CN103729859B (zh) 一种基于模糊聚类的概率最近邻域多目标跟踪方法
CN109633590B (zh) 基于gp-vsmm-jpda的扩展目标跟踪方法
CN102621542B (zh) 基于多模粒子滤波和数据关联的机动微弱目标检测前跟踪方法
CN104237879B (zh) 一种雷达系统中的多目标跟踪方法
CN101221238B (zh) 基于高斯均值移动配准的动态偏差估计方法
CN107193012A (zh) 基于imm‑mht算法的智能车激光雷达机动多目标跟踪方法
CN103678949B (zh) 基于密度分析和谱聚类的多扩展目标跟踪量测集划分方法
CN104931934B (zh) 一种基于pam聚类分析的雷达点迹凝聚方法
CN106980114A (zh) 无源雷达目标跟踪方法
CN106249232A (zh) 基于目标运动态势信息数据关联策略的目标跟踪方法
CN107066806B (zh) 航迹关联方法及装置
CN101975575A (zh) 基于粒子滤波的被动传感器多目标跟踪方法
CN104730511A (zh) 星凸模型下的势概率假设密度多扩展目标跟踪方法
CN104199022B (zh) 一种基于目标模态估计的临近空间高超声速目标跟踪方法
CN105372659A (zh) 道路交通监控多目标探测跟踪方法及跟踪系统
CN104715154B (zh) 基于kmdl准则判据的核k‑均值航迹关联方法
CN106054169A (zh) 基于跟踪信息的多站雷达信号融合检测方法
CN105353352B (zh) 改进搜索策略的mm‑pphdf机动多目标跟踪方法
CN105445731B (zh) 一种基于高精度测速的雷达全自动跟踪方法
CN105844217A (zh) 一种基于量测驱动新生目标强度估计的phd多目标跟踪方法
CN105549004B (zh) 解距离测量模糊的impm‑pphdf方法
CN107436434A (zh) 基于双向多普勒估计的航迹起始方法
CN106019253A (zh) 基于箱粒子cphd的多扩展目标跟踪方法
CN105913080A (zh) 基于随机矩阵的机动非椭圆扩展目标的联合跟踪与分类方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20190627

Address after: 264001 scientific research office, two Road 188, Zhifu District, Yantai, Shandong

Patentee after: Naval Aviation University of PLA

Address before: 264001 scientific research department, 188 road two, Zhifu District, Yantai, Shandong

Patentee before: Naval Aeronautical Engineering Institute PLA

TR01 Transfer of patent right