本发明涉及目标跟踪领域,具体涉及一种基于(variablestructuremultiplemodelgaussianmixtureprobabilityhypothesisdensity,vsmm-gmphd)的多目标跟踪方法。该方法可应用于雷达、红外、可见光目标跟踪,无人机的检测跟踪和移动机器人跟踪、定位等领域。
背景技术:
多目标跟踪需要在被噪声污染的含有杂波的量测中获得多目标的状态,其面临着量测起源不确定、目标运动不确定和检测不确定的困难。其中,量测起源不确定和目标运动不确定是两个主要问题。
量测起源不确定是指量测有可能起源于杂波、虚警、邻近目标或者正在跟踪的目标。基于随机有限集的概率假设密度(probabilityhypothesisdensity,phd)滤波方法较好的解决这一问题。高斯混合(gaussianmixtureprobabilityhypothesisdensity,gm-phd)方法是phd的主要实现方法之一。目标运动不确定是指目标在任何时间可能经历未知或者已知的机动。当目标机动时,单模型并不能很好的表示目标的运动模式,所以需要采用多模型方法(multiplemodel,mm)。mm方法采用的都是固定结构的模型集,而对于多目标跟踪来说,每个目标的运动模式都不同于其他目标;而在不同时间段内,同一个目标的运动模式也会发生改变。变结构多模型(variablestructuremultiplemodel,vsmm)方法,采用不同的准则确定不同时期表示目标运动所需的模型集,可以有限提高计算效率和估计精度。
发明人在文献(dongp,jingz,lim,etal.thevariablestructuremultiplemodelgm-phdfilterbasedonlikelymodelsetalgorithm[c]//201619thinternationalconferenceoninformationfusion(fusion).ieee,2016:2289-2295.)中提出一种基于可能模型集的vsmm-gmphd多目标跟踪方法,发明人还在文献(dongp,jingz,gongd,etal.maneuveringmulti-targettrackingbasedonvariablestructuremultiplemodelgmcphdfilter[j].signalprocessing,2017,141:158-167.)中提出了一种基于期望模式扩增(expectedmodeaugmentation,ema)的vsmm和高斯混合势分布概率假设密度(gaussianmixturecardinalizedprobabilityhypothesisdensity,gmcphd)滤波器的多目标跟踪方法,可以有效的实现量测起源不确定和目标运动不确定情况下的多目标跟踪。前一种方法采用gmphd进行多目标跟踪滤波,效率较高,但是在模型集自适应阶段采用可能模型集方法,只能在现有模型集下进行模型选择,灵活性不够。后一种方法采用基于ema的模型集自适应方法,可以灵活的扩展模型集,但是采用gmcphd作为多目标跟踪滤波器,随这目标和杂波数目则增加计算量增长很快。并且上述两种方法都只适用于线性系统,且没有专门针对多模型方法进行有效的高斯元删减策略。
因此,发明一种基于vsmm-gmphd的多目标跟踪方法很有必要。
技术实现要素:
为此,本发明实施例提供一种可以针对非线性系统的更加高效和准确的基于vsmm-gmphd的多目标跟踪方法,以解决背景技术中的问题。
为了实现上述目的,本发明实施例提供如下技术方案:一种基于vsmm-gmphd的多目标跟踪方法,包括以下步骤:
步骤s1:给定前一时刻的多目标多模型参数:存活目标的高斯元集合及其强度,包含多个运动模式的模型集;
步骤s2:对步骤s1中存活目标的高斯元进行输入混合,包括混合权重、混合概率、混合估计和混合方差,得到混合后的存活目标高斯元集合及其强度;
步骤s3:计算期望模式的加速度,进行模型集的更新,得到当前时刻的模型集;
步骤s4:利用步骤s2中输入混合后的结果和步骤s3中当前时刻的模型集,对混合后的存活目标的高斯元和强度进行预测,得到预测后的存活目标高斯元集合及其强度;对新生目标高斯元集合及其强度进行预测;
步骤s5:根据当前时刻的观测,对步骤s4中得到的预测高斯元和强度进行更新,得到更新后的高斯元集合及其强度;
步骤s6:对步骤s5中更新后的高斯元进行基于模型的修剪与合并;
步骤s7:对步骤s6修剪与合并后的高斯元进行多目标状态提取,得到多目标状态的估计集合和对应的模型集。
优选的,所述步骤s1中,给定当前时刻之前的多目标参数为:k-1时刻存活目标的高斯元集合
其中n(·;m,p)为具有均值m和协方差矩阵p的高斯分布密度函数,ω是高斯元权重,jk-1表示k-1时刻基于模型的高斯元个数,rk-1∈mk-1为模型标签,且mk-1表示在k-1时刻所有有效的模型集,
优选的,所述步骤s2包括:
混合权重
其中
混合概率
混合估计
混合方差
优选的,所述步骤s3包括:
计算当前时刻的期望模型的加速度
得到期望模型集ck,将期望加速度加入总的模型集得到当前时刻的总模型集mk=mk-1∪ck。
优选的,所述步骤s4包括:
计算预测强度dk|k-1(x)
dk|k-1(x)=df,k|k-1(x)+γk(x)
其中df,k|k-1(x)表示存活目标的强度
式中,f(·)表示非线性状态方程,
新生目标强度为
其中πk(r)是模型新生强度jγ,k,
优选的,所述步骤s5包括:
当存在新的传感器观测值时,对存活目标强度进行更新,其计算公式为:
其中,pd(x)表示检测概率,h(·)表示非线性量测方程,
优选的,所述步骤s6包括:
对更新后的高斯元进行基于模型的剪枝与合并
输入:
令l=0,
重复如下步骤:
l:=l+1
对于
i=i\n
直到
输出
其中,t为剪枝阈值,u为合并阈值。
优选的,所述步骤s7包括:
状态提取,可以通过保留大于某一权重ωth的高斯元获得
其中
本发明实施例具有如下优点:
本发明与现有技术相比,其显著优点在于:将ema方法引入vsmm-gmphd中,相比基于可能模型集的方法可以得到更为准确和灵活的模型集自适应效果,相比基于vsmm-gmcphd的方法可以大幅提高计算效率;引入基于扩展卡尔曼滤波的预测和更新方法,通过计算状态方程和量测方程的雅可比矩阵,可以使vsmm-gmphd处理非线性系统;采用基于模型的高斯元剪枝与合并技术,减小了高斯元数量并能得到更为精确的估计。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显。
图1为本发明提供的基于vsmm-gmphd多目标跟踪方法流程图;
图2为本发明提供的gmphd多目标跟踪结果示意图;
图3为本发明提供的vsmm-gmphd多目标跟踪结果示意图;
图4为本发明提供的多目标跟踪的ospa误差距离示意图。
具体实施方式
下面对本发明的实施例作详细说明:本实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式和具体的操作过程。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。
参照说明书附图1-4,该实施例的一种基于vsmm-gmphd的多目标跟踪方法(如图2所示),具体实现步骤如下:
步骤一,给定前一时刻的多目标多模型参数。
k-1时刻存活目标的高斯元集合
其中n(·;m,p)为具有均值m和协方差矩阵p的高斯分布密度函数,ω是高斯元权重,jk-1表示k-1时刻基于模型的高斯元个数,rk-1∈mk-1为模型标签,且mk-1表示在k-1时刻所有有效的模型集,
k-1时刻的总模型集为
步骤二,存活目标高斯元输入混合。
混合权重
其中
混合概率
混合估计
混合方差
步骤三,模型集更新。
计算当前时刻的期望模型的加速度
得到期望模型集ck,将期望加速度加入总的模型集得到当前时刻的总模型集mk=mk-1∪ck。
步骤四,高斯元强度预测。
计算预测强度dk|k-1(x)
dk|k-1(x)=df,k|k-1(x)+γk(x)
其中df,k|k-1(x)表示存活目标的强度
式中,f(·)表示非线性状态方程,
新生目标强度为
其中πk(r)是模型新生强度jγ,k,
步骤五,高斯元强度更新。
当存在新的传感器观测值时,对存活目标强度进行更新,其计算公式为:
其中,pd(x)表示检测概率,h(·)表示非线性量测方程,
步骤六,基于模型的高斯元剪枝与合并。
对更新后的高斯元进行基于模型的剪枝与合并
输入:
令l=0,
重复如下步骤:
l:=l+1
对于
i=i\n
直到
输出
其中,t为剪枝阈值,u为合并阈值。
步骤七,多目标状态提取。
状态提取,可以通过保留大于某一权重ωth的高斯元获得
其中
下面结合附图对本实施例的技术方案进一步详细描述。
考虑一个二维平面的跟踪问题,传感器观测为距离和方位,状态为目标的位置和速度,这是一个典型的非线性系统。本实施例使用matlab语言对所提出的方法进行了测试,并对两种方法进行比较:基于单模型的gmphd算法和本发明提出的方法(vsmm-gmphd)。由于文献dongp,jingz,lim,etal.thevariablestructuremultiplemodelgm-phdfilterbasedonlikelymodelsetalgorithm[c]//201619thinternationalconferenceoninformationfusion(fusion).ieee,2016:2289-2295.和dongp,jingz,gongd,etal.maneuveringmulti-targettrackingbasedonvariablestructuremultiplemodelgmcphdfilter[j].signalprocessing,2017,141:158-167.的方法不能处理非线性系统,因此未作对比。
图2和图3分别给出了gmphd算法和vsmm-gmphd对目标的估计(实线表示目标的真实运动轨迹,圆圈表示估计值),从中可以看出gmphd算法对目标有一定的漏跟踪,而本发明提出的vsmm-gmphd方法可以有效的实现对多目标的稳定跟踪。
图4给出了100次蒙特卡洛仿真ospa误差距离,ospa距离可以同时评价两个随机集的数目和元素的差别。从图中可以看出,本发明提出的vsmm-gmphd方法的ospa误差距离明显小于gmphd算法,可以得到更高的估计精度。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变形或修改,这并不影响本发明的实质内容。