多重搜索粒子概率假设密度滤波的多目标跟踪方法 |
|||||||
申请号 | CN201510791334.X | 申请日 | 2015-11-17 | 公开(公告)号 | CN105353353A | 公开(公告)日 | 2016-02-24 |
申请人 | 中国人民解放军海军航空工程学院; | 发明人 | 谭顺成; 王国宏; 吴巍; 于洪波; | ||||
摘要 | 本 发明 公开了一种多重搜索粒子概率假设 密度 滤波的多目标 跟踪 方法,属于雷达 数据处理 领域。基于粒子概率假设密度滤波的多目标跟踪方法存在一个明显的 缺陷 ,即当目标出现漏检时,重 采样 会造成粒子多样性的迅速退化,进而造成目标丢失的现象,因此该 算法 难以适应目标检测概率较低时的多目标跟踪。本发明提出的多重搜索粒子概率假设密度滤波即立足于解决此类问题。本发明具有结构简单,计算快速,易于 硬件 实现,同时克服了基于一般的粒子概率假设密度滤波方法应用的局限性,对非线性非高斯系统具有较强的适应性,因此具有较强的工程应用价值和推广前景。 | ||||||
权利要求 | 1.多重搜索粒子概率假设密度滤波的多目标跟踪方法,其特征包括以下步骤: |
||||||
说明书全文 | 多重搜索粒子概率假设密度滤波的多目标跟踪方法技术领域背景技术[0002] 粒 子 概 率 假 设 密 度 滤 波 (Particle probability hypothesis density filter,PPHDF)是一种密集杂波环境下对多目标进行跟踪的有效方法。PPHDF通过将量测和目标状态建模为随机集,可以非常方便的从个数时变的量测中估计出个数时变且未知的目标状态,即可同时对目标个数和目标状态进行估计;同时,PPHDF可以避免目标和量测之间的关联问题,极大的降低了多目标跟踪算法的复杂性和计算量。因此,PPHDF在多目标跟踪领域得到了广泛的关注和研究。该方法主要通过以下步骤实现: [0003] (1)初始化,得到初始粒子集; [0004] (2)对已存在的粒子集进行一步预测得到预测粒子集,并生成用于搜索新目标的搜索粒子集,将预测粒子集和搜索粒子集合成新的预测粒子集; [0005] (3)利用新量测对预测粒子集粒子权重进行更新; [0006] (4)对权重更新后的粒子集进行重采样,并得到目标个数和各目标状态估计。 发明内容[0008] 本发明的目的是提出一种多重搜索粒子概率假设密度滤波(MS-PPHDF)的多目标跟踪方法,解决一般的PPHDF方法在目标检测概率较低的情况下容易出现目标丢失的问题。 [0009] 本发明提出的MS-PPHDF方法的技术方案包括以下步骤: [0010] 步骤1:变量初始化 [0011] K是雷达关机时刻; [0012] T是雷达扫描周期; [0013] L0为代表1个目标的粒子数; [0014] D0为目标出现的初始分布; [0015] Jk为搜索新目标的粒子数; [0016] Sk表示搜索1个消失目标的粒子数; [0017] Lk为k时刻滤波器采用的粒子总数; [0018] γk为平均目标出现概率; [0019] PD为目标检测概率; [0021] Fk为状态转移矩阵; [0022] Gk为过程噪声分布矩阵; [0023] Qk为过程噪声协方差; [0024] Rk为量测噪声协方差; [0025] 步骤2:令k=0,初始化粒子集 [0026] 对任意p∈{1,2,…,L0},从初始分布D0中采样粒子 并赋予该粒子权重得到初始粒子集 其中 表示粒子代表的目标状态,包含了目标的位置 和速度 信息; [0027] 步骤3:令k=k+1,获得k时刻的雷达量测 [0028] 将雷达接收到的信号进行A/D变换,得到k 时刻的雷达量测集送雷达数据处理计算机,其中 表示k时刻雷达得 到的第q个量测,包含了目标的距离量测 多普勒速度量测 以及方位量测 等信息,而Mk则表示k时刻雷达得到的量测个数; [0029] 步骤4:预测 [0030] (1)若k≤2,令Ik=0,直接转(4),否则定义集合 [0031] [0032] 其中, 表示k-2时刻存在而k-1时刻消失的第n个目标的状态,Ndis,k-1表示消失的目标数; [0033] (2)若 令Ik=0,直接转(4),否则 令Ik=Ndis,k-1Sk,对任 意根据状态转移方程 [0034] [0035] 进行一步预测,其中 [0036] [0037] (3)对任意n∈{1,2,…,Ndis,k-1}和任意p∈{Lk-1+(n-1)Sk+1,…,Lk-1+nSk},根据[0038] [0039] 采样粒子 并赋予该粒子权重 其中 [0040] [0041] 为过程噪声分布矩阵,vk为过程噪声,其噪声协方差为Qk; [0042] (4)对任意p∈{Lk-1+Ik+1,…,Lk-1+Ik+Jk},根据初始分布D0采样“新生”粒子并赋予该粒子权重 [0043] (5)对任意p∈{1,2,…,Lk-1},根据 [0044] [0045] 采样粒子 并赋予该粒子权重 [0046] 步骤5:更新 [0047] 对任意p∈{1,2,…,Lk-1+Ik+Jk},利用量测集Zk对粒子权重进行更新[0048] [0049] 其中 [0050] [0051] [0052] gk(z|x)为量测似然函数; [0053] 步骤6:重采样 [0054] (1)计算所有粒子的权重和 [0055] [0056] (2)对粒子集 进行重采样,得到新的粒子集其中 为k时刻估计的目标数, Round(x)表示 取与x最接近的整数;步骤7:目标状态估计 [0057] 若 直接转步骤8,否则采用K-均值聚类分析的方法将粒子集 划分为 个类 其中 Lk,n表示第n个类包含的粒子数,满足 则估计的目标状态为 [0058] [0059] 步骤8:重复步骤3~步骤8,直至雷达关机。 [0060] 和背景技术相比,本发明的有益效果说明: [0062] 附图1是本发明提出的MS-PPHDF多目标跟踪方法的整体流程图; [0063] 附图2是本发明实施例中MS-PPHDF方法跟踪多目标的效果展示,附图中星号“*”表示目标的真实位置,圆圈“o”表示估计的目标状态; [0064] 附图3是本发明实施例中一般的PPHDF方法跟踪多目标的效果展示,附图中星号“*”表示目标的真实位置,圆圈“o”表示估计的目标状态。 具体实施方式[0065] 下面结合附图对本发明提出的MS-PPHDF方法进行详细描述。 [0066] 不失一般性,设置一个二维的仿真场景,监测区域 S =[-60km,60km]×[-60km,60km],总仿真时间K=50s。假设目标可在监测区域内随机出现和消失,平均目标出现概率γk=0.2,目标出现的初始分布D0服从均值为x0和协方差为QbT 的正态分布,这里取x0=[30km 0.2km/s 30km-0.1km/s] 和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。 [0067] 其步骤如附图1所示。 [0068] (1)根据以上仿真条件进行变量初始化 [0069] 由以上仿真条件可知 [0070] [0071] 雷达量测方程为 [0072] [0073] 其中Wk为相互独立的零均值高斯白噪声,其协方差为 [0074] [0075] (2)按发明内容部分步骤2所述的方法进行粒子集初始化,得到初始粒子集; [0076] (3)按发明内容部分步骤3所述的方法获得当前时刻雷达量测; [0077] (4)按发明内容部分步骤4所述的方法对粒子集进行一步预测,得到预测的粒子集; [0078] (5)按发明内容部分步骤5所述的方法对预测的粒子集的权重进行更新; [0079] (6)按发明内容部分步骤6所述的方法对权重更新后的粒子集进行重采样; [0080] (7)按发明内容部分步骤7所述的方法得到目标的状态估计; [0081] (8)循环执行发明内容部分步骤3~步骤8,直至雷达关机。 [0082] 实施例条件中,在目标检测概率PD=0.75的情况下,本发明提出的MS-PPHDF方法仍能实现杂波环境下对多目标的有效跟踪(见附图2),而一般的PPHDF方法在目标出现漏检时出现了目标的丢失的情况(见附图3),因此本发明方法可以有效的改善一般PPHDF方法在目标检测概率较低情况下的多目标跟踪性能(附图2和附图3对比)。 |