本发明涉及异步采样系统下多传感器多目标跟踪领域,涉及一种基于phd滤波的异步多传感器融合多目标跟踪方法,用于解决在密集杂波环境的多目标跟踪,提高对监测空间中未知目标的跟踪质量,达到高精度且稳定的跟踪效果。
背景技术:
多传感器多目标跟踪是一类在技术实现上相当复杂的问题,多传感器多目标跟踪过程主要包括目标状态估计和数据融合两个方面。传统的多目标跟踪方法主要包括航迹起始与终结、数据关联、跟踪维持等内容,其中数据关联和跟踪算法是两个最重要的问题,代表算法如联合概率数据关联算法(jointprobabilitydataassociation,jpda)、多假设跟踪算法(multiplehypothesistracking,mht)以及最近邻算法等。在一些简单情况下,例如杂波和漏检较少时,基于数据关联的多目标跟踪方法效果较好且易于工程应用。但是当面对一些复杂环境,例如强杂波和低检测率,或者在目标较多的情况下,会面临数据关联的组合爆炸问题,且易造成错误的数据关联,导致跟踪效果退化。mahler于2003年提出了随机有限集(randomfiniteset,rfs)理论,随后在贝叶斯随机有限集框架基础上提出了多目标跟踪概率假设密度(probabilityhypothesisdensityfilter,phd)滤波算法,该算法利用一阶统计矩近似多目标后验概率密度函数,对其积分后得到多目标强度;同时phd以最小损失将多目标信息状态集合的后验phd投影在单目标状态空间上,避免了多目标贝叶斯滤波器在随机有限集空间上进行递推,通过对探测区域内的phd积分即可获取区域内目标的期望数,而对应的phd峰值即为目标状态。phd滤波算法使计算复杂度大大降低,并有效避免了数据关联问题,为多目标跟踪问题提供了一种新的处理方法。
数据融合是针对使用多个或者多类传感器系统这一特定问题的一种信息处理方法,这种方法是对多源数据进行检测、结合、相关、估计和组合以达到精确的状态信息估计,以及完整、及时的态势评估和威胁估计。数据融合是一个在多个级别上对传感器数据进行综合处理的过程,多传感器可提供关于目标有用的冗余信息,采用基于phd滤波算法的多传感器多目标跟踪方法可以得到关于目标估计描述的统一形式。然而在密集杂波环境下,并没有特定的一种融合算法能解决多传感器间数据融合结果的最优效果,因此提出一种密集杂波环境下的多传感器融合多目标跟踪方法,达到有效且高精度的跟踪效果。
多传感器融合的是各传感器的同步量测值,而在实际多传感器数据融合系统中,传感器间的同步假设很难被保证,且在实际应用中经常遇到的是异步情况。在各传感器的量测数据进行融合之前,首先应该对量测数据进行时间同步配准,即统一各传感器数据的“时间基准”。在实际的多传感器数据融合系统中,由于融合跟踪的具体内容及应用环境不同而对时间配准有不同的要求,另外,传感器自身的性能也有可能影响配准的准确性和实时性,所以在设计多传感器数据融合系统时,应根据具体情况在满足配准要求的前提下,从实时性和准确性两方面来提高配准的最终性能。
技术实现要素:
针对密集杂波环境下,常规的点迹融合算法具有的局限性限制了跟踪效果的提高。本发明提出了一种面向密集杂波下的基于phd滤波的异步多传感器融合多目标跟踪方法,该方法可以提高在密集杂波环境下多传感器对监测区域内目标的估计精度,维持跟踪过程。为了达到上述目的,本发明采用技术方案如下:
(1)构建异步多传感器多目标跟踪场景,并对目标的运动模型进行初始化,设置目标运动的相关参数,包括目标运动的过程噪声和传感器的量测噪声;
(2)结构中设置有m个传感器对目标进行信息采集;所有的传感器类型相同,传感器的测量为目标的位置信息,每个传感器起始采样时间不同且每个传感器依据上一时刻的历史估计信息和自身的量测作为下一时刻的输入,在各个传感器上分别应用高斯混合phd滤波方法对历史估计信息和自身获得的测量值进行滤波,并进行枝剪与合并,,再进行时间配准工作,之后传感器1和传感器2进行数据关联和融合工作,得到一级phd估计;传感器3再与一级phd估计结果进行数据关联和融合操作,得到二级phd估计,以此类推,直至所有传感器融合完毕,最后输出全局phd估计;
本发明的有益效果:针对复杂环境下的异步多传感器数据融合多目标跟踪问题,本发明提出了一套完整的处理方法流程,最主要的是提出了一种基于状态转换的时间配准方法和提出了以传感器的探测概率作为置信度的改进后的凸组合数据融合方法。本发明配置结构明了,计算量小,可广泛应用于多目标跟踪领域。
附图说明
图1是基于phd滤波的异步多传感器融合结构图;
图2是本发明方法与单传感器算法ospa比较图。
具体实施方式
以下结合技术方案和附图,详细叙述本发明的具体实施方式。
(1)构建多传感器多目标跟踪场景,传感器的量测可能来自目标,也可能来自杂波,构建目标的运动模型、传感器的量测模型、杂波模型和异步采样模型,并对它们进行初始化。
建立目标的运动模型:
式中,k表示离散时间变量,i(i=1,2,···,n)表示目标的序号,
如果传感器的量测来自目标,则传感器的量测符合以下传感器量测模型:
式中,j(j=1,2,···,m)表示传感器的序列,
如果传感器的量测来自杂波,则传感器的量测符合以下杂波模型:
式中,nk为k时刻监测空域内的杂波个数,假设杂波数量服从强度为λ泊松分布,ρ(nk)为杂波个数nk的概率函数,yl为第l个杂波的位置状态,ψ(x)为监测空间的体积,q(yl)为第l个杂波出现的概率。
假设各传感器异步采样且不考虑传输延迟,则传感器采样符合以下模型:
式中,t为各传感器相同的采样周期,且系统融合周期与传感器的采样周期相等,各传感器的采样起点不同,δt为在同一个周期内连续采样的两个传感器之间的时间间隔,
(2)构建异步多传感器融合框架。
如图1所示,本发明构造了一种异步多传感数据融合框架,框架中设置有m个传感器对目标进行信息采集。所有的传感器类型相同,传感器的测量为目标的位置信息,每个传感器起始采样时间不同且每个传感器依据上一周期的历史估计信息和自身的量测作为下一周期的输入,在各个传感器上分别应用高斯混合phd滤波方法对历史估计信息和自身获得的测量值进行滤波,并进行枝剪与合并,,再进行时间配准工作,之后传感器1和传感器2进行数据关联和融合工作,得到一级phd估计;传感器3再与一级phd估计结果进行数据关联和融合操作,得到二级phd估计,以此类推,直至所有传感器融合完毕,最后输出全局phd估计。
(2)-1、在各个传感器上分别应用高斯混合phd滤波方法对历史估计信息和自身获得的测量值进行滤波。
高斯混合phd滤波算法具体过程如下:
1)预测新生目标
式中,sm表示第m个传感器,
2)预测已存在目标
式中,
3)更新
先验phd强度密度dk|k-1的高斯和形式为:
式中,n(·;x,p)表示均值为x、协方差为p的高斯分布,jk|k-1表示k时刻的目标个数。
则k时刻后验phd强度密度dk的高斯和形式为:
其中
式中,
(2)-2、枝剪与合并
经过上述更新步后输出后验phd强度密度可用
首先对
(2)-3、时间配准
在第k个周期内,传感器采样时刻与融合时刻之间关系为:
式中,j为传感器序列,kt为融合时刻,
把第k个周期内各传感器的估计得到的目标状态从采样时刻
式中,j为传感器序列,
(2)-4、数据关联。
在数据关联步骤假设存在传感器s1和传感器s2,两传感器利用phd滤波算法对共同探测区域进行滤波后产生的粒子集用集合表示为
现设定关联算法:
1)在融合方法中,将与被跟踪目标预测位置最近的量测作为与目标关联的回波信号,比较每个传感器得到的状态间距离进行关联,对
2)在同一时刻,单个传感器针对同一个被跟踪目标最多只能得到一个状态估计;
3)可能存在同一个被跟踪目标在同一时刻与多个传感器的状态估计信息同时关联成功,针对此种现象,取距离最近的目标作为关联对象;
4)对于无法关联的状态信息予以保留。
其中,
{(w1,x1,p1),(w2,x2,p2),…,(wm,xm,pm)}
(2)-5、构建融合算法
将已经匹配好的状态进行融合,最后的异步多传感器融合多目标跟踪结果为输出的状态信息。在实际应用中常因各传感器的探测率不同,各传感器滤波所得结果的可信度亦不同,因此利用凸组合融合算法,并考虑将各传感器的探测概率作为置信系数,对凸组合融合算法做出改进。具体如下:
式中,m表示传感器个数,pdj为传感器j的探测概率,