基于GM-CPHD滤波算法的主动声呐目标跟踪
2018-09-07陈晓李亚安李余兴蔚婧
陈晓, 李亚安, 李余兴, 蔚婧
(西北工业大学 航海学院, 陕西 西安 710072)
多目标跟踪作为一项关键技术已广泛应用于军事和民用领域[1],比如:空中交通管制、监视、侦察、海洋学及自动驾驶汽车等。随着传感器和计算机技术的发展,多目标跟踪的应用领域将会更加广泛。传统的多目标跟踪算法有:最近邻算法、概率数据关联算法、联合概率数据关联算法、多假设跟踪算法等。虽然这些算法都是基于数据关联实现多目标的跟踪,然而它们并不能实现可变数目多目标的跟踪[2]。近年来,随着随机有限集理论的发展,基于贝叶斯滤波框架利用随机有限集对多目标系统进行建模,基于矩近似的概率假设密度滤波(PHD,probability hypothesis density)[3]算法和带势的概率假设密度滤波(CPHD,cardinalized probability hypothesis density)[4]算法被提出。该算法不仅解决了多目标跟踪中存在的数据关联问题,而且实现了对可变数目目标的跟踪。
在目标跟踪方面,虽然PHD算法是在单个目标运动的状态空间中进行,从而避免了数据关联,但是递推PHD的多目标跟踪算法没有闭合解。B N Vo在深入研究的基础上提出了GM-PHD(Gaussian mixture probability hypothesis density)[5]滤波算法和SMC-PHD(sequential Monte Carlo probability hypothesis density)[6]滤波算法,并且应用于实际问题,如:双基地雷达跟踪[7]、声呐跟踪[8]等。由于PHD滤波算法在缺失真实目标观测的情况下,对目标数目的估计十分敏感,Mahler提出了GM-CPHD(Gaussian mixture cardinalized probability hypothesis density)[9]滤波算法,该算法在传递PHD的同时还传递目标数目的概率密度,可以更好地实现随机有限集的势估计。为了减少该算法的计算量,文献[10]通过跟踪门策略可以有效地减少计算量而不影响多目标跟踪性能。然而对于水下声呐系统的水下多目标跟踪,虽然文献[11]将SMC-PHD滤波算法用于实际声呐目标跟踪,但是并未对检测概率进行分析。文献[12]对变检测概率条件下的GM-PHD滤波性能进行了分析,但其对检测概率的建模缺少声呐方程和水声理论的依据,跟踪性能有待进一步提高。
为了实现声呐系统对水下多目标的跟踪,结合跟踪门策略,提出一种适用于水下声呐系统的自适应检测概率GM-CPHD滤波算法。该算法比传统GM-CPHD滤波算法增加了椭圆跟踪门以减少计算量,同时提高了水下多目标跟踪的性能。结合椭圆门策略,本文对GM-CPHD,自适应检测概率GM-CPHD滤波算法的跟踪性能进行仿真分析,结果表明,自适应检测概率GM-CPHD滤波算法不仅提高了目标个数估计的精确性,同时可以有效地提高多目标跟踪性能。
1 随机集多目标跟踪基础
多目标跟踪目的就是估计当前时刻多个目标的状态以及总的目标个数,如果用随机有限集中的元素表示目标状态,元素的个数表示目标个数,则可以用一个随机有限集表示多目标状态集合,同时传感器的量测集也可以用随机有限集表示,集合元素表示量测值,集合元素数表示观测目标数,这样将多目标问题转化为随机集有限集问题。因此,多目标的状态集合量测集分别以随机有限集表示如下。
(1)
式中,ES表示目标状态空间,Xk表示k时刻状态随机有限集,nk表示k时刻目标个数;Eo表示传感器量测空间,Zk表示k时刻传感器量测随机有限集,mk表示k时刻传感器的量测数。
给定k-1时刻的多目标状态集为Xk-1,综合考虑目标的不同运动情况,则k时刻的目标状态随机集模型可以表示为:
Ξk=Sk|k-1(Xk-1)∪Γk
(2)
式中,Sk|k-1(Xk-1)表示从k-1时刻到k时刻存活的目标随机集,Γk表示新生目标随机集。
假设多目标的状态集为Xk,考虑到传感器量测信息的来源,则传感器量测可以表示为:
Σk=Kk∪Ek(Xk)
(3)
式中,Ek(Xk)表示由Xk产生的量测随机集,Kk表示杂波(虚假量测)的随机集。
随机有限集在多目标跟踪的应用是基于单目标贝叶斯的推广,故其滤波形式可表示如下。
fk|k-1(Xk|Z1:k-1)=
fk|k(Xk|Z1:k)=
(4)
式中,fk|k-1(Xk|Xk-1)和gk|k(Zk|Xk)分别表示多目标状态随机有限集的状态转移函数和量测有限集的似然函数。概率密度函数fk|k-1(Xk|Z1:k-1)和fk|k(Xk|Z1:k)分别表示多目标随机有限集的预测概率密度和后验概率密度。上式给出了多目标贝叶斯滤波的一般形式,但是集积分通常难以求解,因而实际应用中通常利用各种次优算法逼近多目标贝叶斯滤波,比如:GM-PHD,SMC-PHD及其改进算法。
2 GM-CPHD滤波算法
Mahler提出的CPHD滤波算法解决了PHD滤波算法的局限性,不同于PHD滤波算法,该算法同时传递多目标状态有限集的后验强度和集合势的后验分布信息,因此,利用CPHD滤波算法能够获得更加精确地估计目标个数。该算法基于以下假设:
1) 每个目标的运动演化和量测的生成相互独立;
2) 新生目标随机有限集和存活目标随机有限集相互独立;
3) 杂波随机有限集是独立泊松过程且与量测随机有限集相互独立;
4) 预测和后验多目标随机有限集均为独立泊松过程。
(5)
单传感器的CPHD滤波[4]递推公式可描述如下,假设k-1时刻状态后验强度为vk-1,后验势分布为ρk-1,那么预测过程如(6)、(7)式所示。
式中
pS,k(ζ)表示目标时刻的存活概率,fk|k-1(x|ζ)表示状态转移概率密度,γk(x)为新生目标强度,ρΓ,k为新生目标势分布。
更新过程如(8)、(9)式所示。
由于CPHD滤波算法的递归过程中仍存在多重积分,并不存在闭合解。在线性高斯的条件下,CPHD可以由高斯混合的形式实现,即GM-CPHD滤波算法。该算法遵循以下假设条件:
1) 新生目标的强度是高斯混合形式,即:
(12)
2) 每个目标的遵守线性高斯动力学模型,即:
fk|k-1(x|ζ)=N(x:Fk-1ζ,Qk-1)
gk(z|x)=N(z:Hkx,Rk)
(13)
3) 存活概率和检测概率相互独立,即:
PS,k(x)=PS,k
Pd,k(x)=Pd,k
(14)
GM-CPHD滤波算法的递推过程如下描述:
(1) 预测
假设k-1时刻的先验强度vk-1(x)和势分布ρk-1(x)已知,且vk-1(x)服从高斯混合分布,则预测的强度和势分布分别如(15)、(16)式所示。
vk|k-1(x)=vS,k|k-1(x)+γk(x)
(15)
(16)
式中,γk(x),vS,k|k-1(x)如(17)式所示。
(17)
(2) 更新
式中
3 自适应检测概率GM-CPHD滤波算法
3.1 跟踪门策略
在传统多目标跟踪中,利用跟踪门来得到有效量测,将其应用于GM-CPHD同样可以降低量测有限集的势,从而减少该算法的计算量,椭圆跟踪门的定义如下式所示。
(22)
(23)
3.2 自适应检测概率
水下目标跟踪的实现受检测概率的影响,精确的检测概率可以保障目标跟踪的有效性及精确性。以水声理论为基础,利用声呐方程对检测概率随跟踪距离变化进行建模,得到自适应检测概率,以此为基础分析检测概率对GM-CPHD滤波算法的影响。
水下目标跟踪系统的设计离不开声呐方程,根据工作方式的不同,声呐可分为主动声呐和被动声呐,其中以噪声为主要背景干扰的主动声呐方程[13]如(24)式所示。
SL-2TL+TS-(NL-DI)=DT
(24)
式中,SL为发射声源级,TL为传播损失,TS为目标强度,NL为环境噪声级,DI为指向性指数,DT为检测阈。由于传播损失可以表示为距离的函数,间接地,信噪比和检测阈也可以表示为距离的函数。根据声呐检测理论,信噪比与检测概率以及虚警概率3者之间的关系通过接收机工作特性(ROC)曲线完整表示。所以,检测概率与距离之间的关系可以通过声呐方程和ROC曲线建模得到。根据信号检测理论[14],其推导过程如下。
对于已知信号的检测,假设检测判决模型如(25)式所示
H1:x(t)=s(t)+n(t)
H0:x(t)=n(t)
(25)
式中,s(t)为已知信号,n(t)均值为0的高斯白噪声,以Δt为采样间隔得到离散时间序列。
二元假设检测的似然比如(26)式所示。
(26)
将上式简化可得:
(27)
(28)
(29)
至此得到虚警概率和检测概率分别为:
(30)
由(30)式可得:
(31)
假设采用主动检测方式,距离较远时波阵面为柱面波,因此传播损失TL=10lg(r),根据(24)式有:RSN=SL-2TL-NL+TS+DI,结合(31)式,得检测概率、虚警和距离之间的关系式为。
(32)
由于虚警的不确定性无法得到检测概率与距离的解析关系,此处选择奈曼皮尔逊准则作为判决标准,即:虚警概率一定的条件下使得检测概率达到最大。假设:声源级SL=120 dB,5级海况下NL=55 dB,目标强度为艇艏艉方向的强度TS=10 dB,暂不考虑指向性指数DI=0,给定不同虚警概率的情况下,由(32)式求解得到的关于检测概率和距离的关系如图1所示。
图1 检测概率随距离的变化示意图
从图1可以看出,当距离一定的时候,虚警概率越大检测概率越大;检测概率一定的时候,距离越远虚警概率越大。无论虚警概率值如何选择,检测概率随距离的增加成递减趋势,而虚警概率越小,检测概率衰减越快。
3.2 自适应检测概率GM-CPHD滤波算法
通过对检测概率的建模分析可知:随着目标跟踪距离的变化,虚警和检测概率出现此消彼长的变化趋势,而在CPHD滤波更新方程中,检测概率直接影响到已检和漏检两部分高斯分量大小,因此,结合水声环境,此处假设虚假概率Pf=0.001,利用检测概率(32)式替换GM-CPHD滤波算法公式(18)、(19)中的检测概率,结合椭圆跟踪门策略,从而可以提高滤波器的估计精度。
4 仿真结果分析
图2 目标运行轨迹图
在不同杂波环境下,当检测概率分别为0.7,0.8,0.9和自适应检测概率时的GM-CPHD滤波算法分别进行50次蒙特卡罗仿真。
如图3~图5所示,在不同杂波密度环境下,针对不同固定检测概率和自适应检测概率的GM-CPHD滤波算法对目标数目的估计进行比较,随着杂波密度的增大,固定检测概率的GM-CPHD滤波算法在80 s之后目标数统计值明显偏离真实,随着时间的偏移,且存在检测概率越高,目标势的估计误差越大的局势。这是因为实际环境中,随着目标的远离,检测概率逐渐减小,漏检的目标数目越来越多,然而GM-CPHD算法具有固定检测概率,导致“不可信”量测用来更新目标数目而导致估计精度越来越差。对于自适应检测概率GM-CPHD滤波算法,由于目标离原点距离超过2 km之后,其检测概率降至0.4之下,但仍具有一定的跟踪效果,而对目标势的估计出现较多的误差。总体而言,自适应检测概率GM-CPHD滤波算法对目标势的估计更准确。
图3 杂波强度λ=5时对目标数目统计比较
图4 杂波强度λ=10时对目标数目统计比较
图5 杂波强度λ=20时对目标数目统计比较
时间平均OSPA距离GM-CPHDPd=0.7Pd=0.8Pd=0.9自适应检测概率GM-CPHDλ=545.1352.6467.2835.31 λ=1049.4353.6364.631.57 λ=2054.0957.4762.8732
如表1所示:通过OPSA距离[15]对多目标跟踪性能进行衡量。随着杂波强度的增大,当固定检测概率时,GM-CPHD滤波算法其时间平均OSPA距离有增大趋势,因短距离情况下,高检测概率更接近真实检测概率对多目标跟踪精度高,而当距离增大时,其同样存在高检测概率导致"不可信"量测被用来估计目标状态,对于目标势估计的错误最终使得目标跟踪性能下降,故时间平均OPSA距离总体较大。而对于自适应检测概率GM-CPHD滤波算法,由于该算法中检测概率的误差小,不仅提高对目标势的估计,同时可以更精确地实现多目标跟踪。总体而言,该算法比固定检测概率GM-CPHD具有更好的跟踪性能。
5 结 论
针对水下目标跟踪的应用,本文在椭圆跟踪门策略的基础上,结合声呐方程,利用信号检测理论对检测概率、虚警概率和距离进行建模,选择奈曼皮尔逊准则作为判决标准,得到当虚警概率一定的条件下,自适应检测概率与距离之间关系的解析式,并将其应用于GM-CPHD滤波算法,提出了自适应检测概率GM-CPHD滤波算法。对不同固定检测概率GM-CPHD滤波算法和自适应检测概率GM-CPHD滤波算法进行仿真,结果表明:随着杂波强度的增大,在目标势的估计方面该算法优于固定检测概率GM-CPHD滤波算法,同时该算法也提高了多目标跟踪性能。