本发明涉及目标跟踪技术领域,具体而言,涉及一种杂波环境下的模糊数据关联方法及多目标跟踪方法。
背景技术:
多目标跟踪技术中最重要而又最困难的问题是如何进行有效的数据关联。目前主流的有效数据关联方法有:联合概率数据关联(jpda)、简易联合概率数据关联(cjpda)、多假设跟踪(mht)、多概率假设(mph)以及粒子滤波等。上述方法都是基于概率统计的思想,而在实际情况中,杂波环境下中存在虚警、漏检,实际的传感器系统总是不可避免的存在测量误差,跟踪环境的先验知识难以统计等问题,这些不确定性导致目标与其观测回波之间的对应关系存在模糊性,目标跟踪性能有待进一步改善。
经过大量检索发现一些典型的现有技术,如申请号201410317097.9的专利公开了一种基于动态规划的强杂波环境中弱小目标检测前跟踪方法,其具有提高检测跟踪性能的优点。又如申请号为201610835472.8的专利公开了一种低可观测高杂波条件下的多目标检测与跟踪方法,能有效减少相邻目标之间的影响。又如申请号为201610942027.1的专利公开了一种适用于杂波环境的多多目标跟踪方法及跟踪系统,其有效地解决了现有方法在新目标出现后的前几个时间步不能提供新目标状态估计的问题。
可见,对于杂波环境下的目标跟踪技术,其实际应用中的亟待处理的实际问题(如提高目标跟踪性能等)还有很多未提出具体的解决方案。
技术实现要素:
为了克服现有技术的不足提供了一种杂波环境下的模糊数据关联方法及多目标跟踪方法,本发明的具体技术方案如下:
一种杂波环境下的模糊数据关联方法,包括以下步骤:
步骤1,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵;
步骤2,通过互联规则构建统计距离;
步骤3,利用kl散度正则信息约束目标函数;
步骤4,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率;
步骤5,利用概率加权更新目标状态及协方差。
可选的,在步骤1中,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵通过模糊数学的隶属度函数完成。
可选的,在步骤2中,统计距离通过以下公式计算而得:
可选的,在步骤3中,利用kl散度正则信息约束目标函数的具体方法包括以下步骤:
步骤3a,采用kl散度正则约束,以最小无偏地描述数据点和类中心的隶属度,其表达式为:
步骤3b,通过拉格朗日乘子法,将目标函数定义为:
其中,权重uij满足约束条件
可选的,在步骤4中,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率的具体方法包括以下步骤:
步骤4a,最小化目标函数,得权重uij为:
步骤4b,归一化关联权重,得到量测与目标航迹的互联概率为:
可选的,在步骤5中,利用概率加权更新目标状态及协方差的具体方法包括以下步骤:
5a,通过概率加权融合得到第i个目标的状态及协方差更新值分别为:
步骤5b,更新的状态估计对应的误差协方差为:
pi,k=φi0,kpi,k [i-ki,khi,k]pi,k;
其中,
可选的,在步骤5a中,若没有一个量测是源于目标的正确量测,即l=0时,状态更新值用预测值代替,其公式为
其中,
与上述一种杂波环境下的模糊数据关联方法相对应的,本发明还提供一种多目标跟踪方法,其包括上述所述的一种杂波环境下的模糊数据关联方法。
本发明所取得的有益效果包括:在多目标跟踪实时性方面得到了较大的改善,并且其多目标跟踪精度、有效跟踪率与经典的jpda(联合概率数据关联)算法相近,能够达到有效跟踪目标的要求。
附图说明
从以下结合附图的描述可以进一步理解本发明,将重点放在示出实施例的原理上。
图1是本发明实施例中一种杂波环境下的模糊数据关联方法的流程示意图;
图2是本发明实施例中在杂波密度为1时,杂波干扰下的目标轨迹图;
图3是本发明实施例中jpda、cjpda以及fjpda三种方法在过程噪声标准差为qii=0.02时,目标1的跟踪均方误差对比图;
图4是本发明实施例中jpda、cjpda以及fjpda三种方法在过程噪声标准差为qii=0.02时,目标2的跟踪均方误差对比图;
图5是本发明实施例中jpda、cjpda以及fjpda三种方法在过程噪声标准差为qii=0.1时,目标1的跟踪均方误差对比图;
图6是本发明实施例中jpda、cjpda以及fjpda三种方法在过程噪声标准差为qii=0.1时,目标2的跟踪均方误差对比图;
图7是本发明实施例中jpda、cjpda以及fjpda三种方法在杂波密度λ=2时,目标1的跟踪均方误差对比图;
图8是本发明实施例中jpda、cjpda以及fjpda三种方法在杂波密度λ=2时,目标2的跟踪均方误差对比图。
具体实施方式
为了使得本发明的目的、技术方案及优点更加清楚明白,以下结合其实施例,对本发明进行进一步详细说明;应当理解,此处所描述的具体实施例仅用于解释本发明,并不用于限定本发明。对于本领域技术人员而言,在查阅以下详细描述之后,本实施例的其它系统、方法和/或特征将变得显而易见。旨在所有此类附加的系统、方法、特征和优点都包括在本说明书内、包括在本发明的范围内,并且受所附权利要求书的保护。在以下详细描述描述了所公开的实施例的另外的特征,并且这些特征根据以下将详细描述将是显而易见的。
本发明实施例的附图中相同或相似的标号对应相同或相似的部件;在本发明的描述中,需要理解的是,若有术语“上”、“下”、“左”、“右”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或组件必须具有特定的方位、以特定的方位构造和操作,因此附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制,对于本领域的普通技术人员而言,可以根据具体情况理解上述术语的具体含义。
本发明为一种杂波环境下的模糊数据关联方法及多目标跟踪方法,根据附图所示讲述以下实施例:
实施例一:
多目标跟踪技术中最重要而又最困难的问题是如何进行有效的数据关联。目前主流的有效数据关联方法有:联合概率数据关联(jpda)、简易联合概率数据关联(cjpda)、多假设跟踪(mht)、多概率假设(mph)以及粒子滤波等。
杂波环境下,联合概率数据关联方法对多目标跟踪具有良好的性能,然而,该方法中的联合事件数是所有候选回波数的指数函数,随着回波密度的增加,计算负荷呈几何级增长。简易联合概率数据关联通过粗略计算概率,设定阈值以构建新的简化确认矩阵,降低了计算量,由于概率之和不为零,会出现漏检情况。多假设跟踪由于综合考虑目标的维持、消失等情况,假设的组合数随目标个数的增加而急剧增大。近年来,序贯蒙特卡洛(又称粒子滤波器)也被广泛应用到多目标跟踪中来,该方法的跟踪性能较大依赖于粒子数目,计算量大,较难实现实时跟踪。
上述方法都是基于概率统计的思想,而在实际情况中,杂波环境下中存在虚警、漏检,实际的传感器系统总是不可避免的存在测量误差,跟踪环境的先验知识难以统计等问题,这些不确定性导致目标与其观测回波之间的对应关系存在模糊性。
假设跟踪区域中目标数量为nt,k 1时刻确认区域中的量测数量为mk 1,z(k 1)表示k 1时刻落入目标相关波门内的候选回波集合,即:z(k 1)={z1(k 1),z2(k 1),…,zm(k 1)}。
定义目标i的状态方程为:xi(k 1)=fi(k)xi(k) gi(k)vi(k)。式中,xi(k)表示k时刻目标i的状态向量,fi(k)表示k时刻目标i的状态转移矩阵,gi(k)表示k时刻的过程噪声分布阵,vi(k)表示均值为零、协方差为qi(k)的高斯过程噪声序列。
定义目标i的量测向量为:zi(k 1)=hi(k)xi(k) gi(k)wi(k)。式中,hi(k)表示k时刻目标i的量测矩阵,wi(k)表示均值为零、协方差为ri(k)的高斯过程噪声序列,且量测噪声序列与过程噪声序列不相关。
在噪声杂波环境中,每次扫描得到的确认量测数大于目标数量,即mk>nt,这种情况在密集杂波环境下尤其明显。杂波环境下,k时刻扫描得到的每个候选量测可能来自目标,也可能来自杂波。每个目标的真实量测以一定的检测概率出现在每次扫描中,同时可能会漏测有些目标。由于确认区域内的量测之间空间距离很近,很难准确地直接将每个目标与其真实量测对应,模糊数学的隶属度函数可以用来表示量测-目标航迹互联判决中本身存在的不确定性,以此建立候选量测与目标的互联矩阵,然后通过计算得到候选量测源于不同目标或杂波的概率,最终利用概率加权得到目标的状态估计,可以实现对多目标的实时跟踪。
对于有效量测集z(k 1)={z1(k 1),z2(k 1),…,zm(k 1)},为了避免陷入局部最大值,根据目标跟踪的特点,采用c个目标的预测观测值作为聚类中心。多目标跟踪数据关联过程可以描述为优化模糊聚类,相应的代价函数为:
d(xi,cj)表示点与聚类中心之间的欧式距离,归一化距离平方为:
如图1所示,本实施例提供一种杂波环境下的模糊数据关联方法,其包括以下步骤:
步骤1,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵;
步骤2,通过互联规则构建统计距离;
步骤3,利用kl散度正则信息约束目标函数;
步骤4,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率;
步骤5,利用概率加权更新目标状态及协方差。
其中,在步骤1中,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵通过模糊数学的隶属度函数完成。
由于每个目标航迹确认区域内的候选量测来自该目标的概率可能性大于外部量测,其关联概率与目标检测概率
由此,在步骤2中,统计距离通过以下公式计算而得:
其
作为一种优选的技术方案,在步骤3中,利用kl散度正则信息约束目标函数的具体方法包括以下步骤:
步骤3a,采用kl散度正则约束,以最小无偏地描述数据点和类中心的隶属度,其表达式为:
步骤3b,通过拉格朗日乘子法,将目标函数定义为:
其中,权重uij满足约束条件
作为一种优选的技术方案,在步骤4中,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率的具体方法包括以下步骤:
步骤4a,最小化目标函数,得隶属度,即权重uij为:
步骤4b,归一化关联权重,得到量测与目标航迹的互联概率为:
注意到,若量测位于目标航迹的确认区域外,即dij(k 1)=∞时,uij=0,符合实际情况。
从上述表达式可以知道,uij的取值与权重指数p有关,权重指数p越大,隶属度越小。
若p=2,uij的取值取决于公式
作为一种优选的技术方案,在步骤5中,利用概率加权更新目标状态及协方差的具体方法包括以下步骤:
5a,通过概率加权融合得到第i个目标的状态及协方差更新值分别为:
步骤5b,更新的状态估计对应的误差协方差为:
pi,k=φi0,kpi,k [i-ki,khi,k]pi,k;
其中,
其中,在步骤5a中,若没有一个量测是源于目标的正确量测,即l=0时,状态更新值用预测值代替,其公式为
实施例二:
与实施例一相对应,本实施例提供一种多目标跟踪方法,其包括如下步骤:
步骤1,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵;
步骤2,通过互联规则构建统计距离;
步骤3,利用kl散度正则信息约束目标函数;
步骤4,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率;
步骤5,利用概率加权更新目标状态及协方差,以实现对多目标的跟踪。
其中,在步骤1中,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵通过模糊数学的隶属度函数完成。
由于每个目标航迹确认区域内的候选量测来自该目标的概率可能性大于外部量测,其关联概率与目标检测概率
由此,在步骤2中,统计距离通过以下公式计算而得:
其
作为一种优选的技术方案,在步骤3中,利用kl散度正则信息约束目标函数的具体方法包括以下步骤:
步骤3a,采用kl散度正则约束,以最小无偏地描述数据点和类中心的隶属度,其表达式为:
步骤3b,通过拉格朗日乘子法,将目标函数定义为:
其中,权重uij满足约束条件
作为一种优选的技术方案,在步骤4中,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率的具体方法包括以下步骤:
步骤4a,最小化目标函数,得隶属度,即权重uij为:
步骤4b,归一化关联权重,得到量测与目标航迹的互联概率为:
注意到,若量测位于目标航迹的确认区域外,即dij(k 1)=∞时,uij=0,符合实际情况。
从上述表达式可以知道,uij的取值与权重指数p有关,权重指数p越大,隶属度越小。
若p=2,uij的取值取决于公式
作为一种优选的技术方案,在步骤5中,利用概率加权更新目标状态及协方差的具体方法包括以下步骤:
5a,通过概率加权融合得到第i个目标的状态及协方差更新值分别为:
步骤5b,更新的状态估计对应的误差协方差为:
pi,k=φi0,kpi,k [i-ki,khi,k]pi,k;
其中,
其中,在步骤5a中,若没有一个量测是源于目标的正确量测,即l=0时,状态更新值用预测值代替,其公式为
为验证本发明所述的一种杂波环境下的模糊数据关联方法及多目标跟踪方法的关联性能,并与现有方法进行比较,本发明采用两个目标交叉运动的例子。设置montecarlo仿真次数为100次,分析比较jpdaf,cjpdaf与fjpdaf的位置均方根误差(rms),mc仿真运行时间、航迹丢失率及正确关联率。
运动目标的系统模型为
转换量测后的量测模型为
其中,t表示观测的时间间隔,t=1s,目标矢量表示为位置和速度
图2给出了在杂波密度为1时,杂波干扰下的目标轨迹图。两个目标的初始位置为
图3、图4、图5以及图6给出了jpda,cjpda及fjpda三种方法在过程噪声标准差分别为qii=0.02和qii=0.1时的跟踪均方误差对比。可以看出,fjpda(模糊联合概率数据关联)方法的多目标跟踪性能优于jpda(联合概率数据关联)及cjpda(简易联合概率数据关联),且随着噪声增大,对比效果更为明显。
在实时性方面,在杂波密度λ=1时,本发明所述的一种杂波环境下的模糊数据关联方法的运行速度,要明显高于jpdaf,但要劣于cjpdaf,其主要原因是随着杂波的增加,算法计算隶属度计算量增大。
图7以及图8给出了杂波密度λ=2时,jpda,cjpda及fjpda三种方法的跟踪均方误差对比。可以看出,随着杂波密度增加,本文所述的一种杂波环境下的模糊数据关联方法的跟踪性能优势更加明显。
综上所述,经过试验以及分析比较可以知道,本发明所述的一种杂波环境下的模糊数据关联方法在多目标跟踪实时性方面得到了较大的改善,并且其多目标跟踪精度、有效跟踪率与经典的jpda(联合概率数据关联)算法相近,能够达到有效跟踪目标的要求。
虽然上面已经参考各种实施例描述了本发明,但是应当理解,在不脱离本发明的范围的情况下,可以进行许多改变和修改。也就是说上面讨论的方法、系统和设备是示例,各种配置可以适当地省略、替换或添加各种过程或组件。例如,在替代配置中,可以以与所描述的顺序不同的顺序执行方法和/或可以添加、省略和/或组合各种部件。而且,关于某些配置描述的特征可以以各种其他配置组合,如可以以类似的方式组合配置的不同方面和元素。此外,随着技术发展其中的元素可以更新,即许多元素是示例,并不限制本发明公开或权利要求的范围。
在说明书中给出了具体细节以提供对包括实现的示例性配置的透彻理解。然而,可以在没有这些具体细节的情况下实践配置,例如已经示出了众所周知的电路、过程、算法、结构和技术而没有不必要的细节,以避免模糊配置。该描述仅提供示例配置,并且不限制权利要求的范围,适用性或配置。相反,前面对配置的描述将为本领域技术人员提供用于实现所描述的技术的使能描述。在不脱离本发明公开的精神或范围的情况下,可以对元件的功能和布置进行各种改变。
综上,其旨在上述详细描述被认为是例示性的而非限制性的,并且应当理解,以下权利要求(包括所有等同物)旨在限定本发明的精神和范围。以上这些实施例应理解为仅用于说明本发明而不用于限制本发明的保护范围。在阅读了本发明的记载的内容之后,技术人员可以对本发明作各种改动或修改,这些等效变化和修饰同样落入本发明权利要求所限定的范围。
1.一种杂波环境下的模糊数据关联方法,其特征在于,包括以下步骤:
步骤1,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵;
步骤2,通过互联规则构建统计距离;
步骤3,利用kl散度正则信息约束目标函数;
步骤4,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率;
步骤5,利用概率加权更新目标状态及协方差。
2.如权利要求1所述的一种杂波环境下的模糊数据关联方法,其特征在于,在步骤1中,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵通过模糊数学的隶属度函数完成。
3.如权利要求2所述的一种杂波环境下的模糊数据关联方法,其特征在于,在步骤2中,统计距离通过以下公式计算而得:
4.如权利要求3所述的一种杂波环境下的模糊数据关联方法,其特征在于,在步骤3中,利用kl散度正则信息约束目标函数的具体方法包括以下步骤:
步骤3a,采用kl散度正则约束,以最小无偏地描述数据点和类中心的隶属度,其表达式为:
步骤3b,通过拉格朗日乘子法,将目标函数定义为:
其中,权重uij满足约束条件uij∈[0,1],
5.如权利要求4所述的一种杂波环境下的模糊数据关联方法,其特征在于,在步骤4中,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率的具体方法包括以下步骤:
步骤4a,最小化目标函数,得权重uij为:
步骤4b,归一化关联权重,得到量测与目标航迹的互联概率为:
6.如权利要求5所述的一种杂波环境下的模糊数据关联方法,其特征在于,在步骤5中,利用概率加权更新目标状态及协方差的具体方法包括以下步骤:
5a,通过概率加权融合得到第i个目标的状态及协方差更新值分别为:
步骤5b,更新的状态估计对应的误差协方差为:
pi,k=φi0,kpi,k [i-ki,khi,k]pi,k;
其中,
7.如权利要求6所述的一种杂波环境下的模糊数据关联方法,其特征在于,在步骤5a中,若没有一个量测是源于目标的正确量测,即l=0时,状态更新值用预测值代替,其公式为
其中,
8.一种多目标跟踪方法,其特征在于,包括以下步骤:
步骤1,根据确认区域内量测的分布情况建立候选量测与目标的互联矩阵;
步骤2,通过互联规则构建统计距离;
步骤3,利用kl散度正则信息约束目标函数;
步骤4,通过迭代优化算法计算出各候选量测与观测区域内不同目标之间的互联概率;
步骤5,利用概率加权更新目标状态及协方差,以实现对多目标的跟踪。
技术总结