一种适用于杂波环境的多目标跟踪方法及跟踪系统

摘要

本发明提供一种适用于杂波环境的多目标跟踪方法，其中，所述方法包括：预测步骤、分类步骤、更新步骤、裁减与提取步骤、生成步骤、补充步骤、合并步骤。本发明还提供一种适用于杂波环境的多目标跟踪系统。本发明提供的技术方案具有处理速度快的特点，同时有效地解决了现有方法在新目标出现后的前几个时间步不能提供新目标状态估计的问题。

主权项

一种适用于杂波环境的多目标跟踪方法，其特征在于，所述方法包括：预测步骤、根据前一时刻各个目标的边缘分布和存在概率，以及当前时刻与前一时刻的时间差，预测前一时刻已存在的各个目标在当前时刻的边缘分布和存在概率；其中，以k‑1表示前一时刻，k表示当前时刻，t_k‑1表示前一时刻的时间，t_k表示当前时刻的时间，k‑1时刻目标i的边缘分布和存在概率分别表示为N(x_i,k‑1；m_i,k‑1,P_i,k‑1)和ρ_i,k‑1，其中N表示高斯分布，i＝1,2,…N_k‑1，x_i,k‑1为k‑1时刻目标i的状态向量，m_i,k‑1和P_i,k‑1分别表示k‑1时刻目标i的状态均值和协方差，N_k‑1为前一时刻目标的总数；由k‑1时刻目标i的边缘分布N(x_i,k‑1；m_i,k‑1,P_i,k‑1)和存在概率ρ_i,k‑1，预测k‑1时刻的目标i在k时刻的边缘分布和存在概率分别为N(x_i,k；m_i,k|k‑1,P_i,k|k‑1)和ρ_i,k|k‑1，其中m_i,k|k‑1＝F_i,k|k‑1m_i,k‑1，P_i,k|k‑1＝Q_i,k‑1+F_i,k|k‑1P_i,k‑1(F_i,k|k‑1)^T，ρ_i,k|k‑1＝p_S,k(Δt_k)ρ_i,k‑1，F_i,k|k‑1为状态转移矩阵，上标T表示矩阵或向量的转置，Δt_k＝t_k‑t_k‑1为k时刻与k‑1时刻的时间差，Q_i,k‑1为k‑1时刻目标i的过程噪声协方差矩阵，p_S,k(Δt_k)为目标的幸存概率，且T为采样周期，δ为给定的常数，i＝1,2,…N_k‑1；分类步骤、根据前一时刻已存在的各个目标在当前时刻的预测边缘分布和预测存在概率，以及当前时刻的测量集，确定出测量集中的每个测量是否源于前一时刻已存在的目标，并分别进行归类；更新步骤、根据前一时刻已存在的各个目标在当前时刻的预测边缘分布和预测存在概率，以及当前时刻源于已存在目标的测量，利用贝叶斯规则确定前一时刻已存在的各个目标在当前时刻的更新边缘分布和更新存在概率；裁减与提取步骤、根据前一时刻已存在的各个目标在当前时刻的更新边缘分布和更新存在概率，将存在概率小于第一阈值的目标裁减掉，同时提取存在概率大于第二阈值的目标的边缘分布作为当前时刻的输出；生成步骤、利用当前时刻的其它测量和其前两时刻的其它测量产生新目标，并利用最小二乘法估计新目标在当前时刻的状态均值、协方差和边缘分布；补充步骤、提取新目标在当前时刻的边缘分布对当前时刻的输出进行补充，并提取新目标在前两个时刻的状态估计分别对前两个时刻的输出进行补充；合并步骤、将在所述裁减与提取步骤中裁减后余下目标的边缘分布和存在概率，分别与在所述生成步骤中生成的新目标在当前时刻的边缘分布和存在概率进行合并，形成当前时刻各个目标的边缘分布和存在概率，并作为下一次递归的输入。