Sensor Control Based on Multiple Feature Optimization in Multiple Extended Targets Tracking
-
摘要: 针对多扩展目标的优化跟踪问题,该文在有限集统计(FISST)理论框架下,提出一种能够综合优化多扩展目标跟踪性能的传感器控制方法。首先,该文给出加权广义最优子模式分配(WGOSPA)距离构造多扩展目标跟踪多特征估计在其统计平均周围的广义离差,进而研究提出多特征融合下的传感器控制最优决策方法,并利用序贯蒙特卡罗(SMC)技术研究传感器控制最优决策过程的数值求解方法,然后利用伽马高斯逆威沙特多伯努利(GGIW-MBer)滤波器实现所提出的传感器控制策略。最后通过仿真实验验证了所提算法的有效性。
-
关键词:
- 传感器控制 /
- 多扩展目标跟踪 /
- 评价函数 /
- 有限集统计 /
- 伽马高斯逆威沙特混合
Abstract: Focusing on the optimal tracking problem of multiple extended targets, a sensor control method is proposed, which can comprehensively optimize the tracking performance of multiple extended targets in the framework of FInite Set STatistics (FISST). First, a Weighted Generalized Optimal Sub-Pattern Assignment (WGOSPA) distance is proposed to construct multiple extended targets tracking multiple feature estimation of generalized dispersion around its statistical average. In addition, an optimal decision-making method of sensor control through the multi-characteristic fusion is studied and proposed. Furthermore, the numerical solution method of the optimal decision-making process of sensor control is studied by using Sequential Monte Carlo (SMC) technology. Then, the proposed sensor control strategy is realized by using Gamma Gaussian Inverse Wishart Multi-Bernoulli (GGIW-MBer) filter. Finally, the effectiveness of the proposed algorithm is verified by simulation experiments. -
1. 引言
现代目标跟踪系统[1-6]中,传感器的智能性和可控性越来越高,科学制定最优管理策略以控制传感器合理运行,能够很大程度上改善并优化传感器接收信息的质量,从而显著提升目标跟踪系统的整体性能,这就是传感器控制(亦称为传感器管理)的根本意义之所在。传感器控制是为了满足操作约束并完成相应的操作目标,在一个灵活可调节的传感器系统中进行相应的自由度控制[7],其目的是在正确的时间将正确平台上的可控传感器引导至最优的观测状态,从而获取最优的量测过程[8,9]。然而,复杂的多目标跟踪系统往往伴随着目标的不确定性,同时还受传感器检测的不确定性以及杂波干扰等因素的影响,使得能有效决策最优传感器控制的方法研究极为困难。
近些年,基于有限集统计(FInite Set STatistics, FISST)理论[10-12]的多目标跟踪方法因其更为科学的多目标建模方式而广受关注。在FISST理论框架下更有利于对集群目标进行跟踪估计,对于多目标跟踪估计整体优化的传感器控制决策方案的制定是极其便利的。目前已经产生了一些颇为有效的传感器控制方法并应用于目标跟踪优化,这些传感器控制方法基本可分为两大类:一种是基于信息驱动,此类方法通过多目标概率密度的信息增益来评估量测过程的优劣,而信息增益可以由各类散度函数来量化(例如Kullback-Leible散度[13]、Cauchy-Schwarz散度[14,15]、Rényi散度[16]、巴氏距离[8]等),旨在控制传感器获得最大的信息增益。另一种是基于任务驱动,此类方法基于特定任务优化而决策,通常在实际应用环境下能够发挥其重要作用,包括基于目标威胁评估[17,18]、基于目标势估计方差[19]、基于状态和势估计误差的后验期望[20]、基于目标势的后验期望[21]等。基于任务驱动的传感器控制的目标更为明确,直接针对多目标跟踪系统的预期性能和特定要求。但是如何科学设计任务规划准则,以增强滤波器在复杂环境下的多目标综合多特征估计的稳健性,显然还值得深入研究。
随着高精度传感器不断运用和被跟踪目标的集群化发展,对多扩展目标跟踪(Multiple Extended Targets Tracking, METT)[22-28]问题的深入研究已经成为现代目标跟踪领域的焦点。METT借助辨识度更高且更丰富的量测信息利用信息融合技术可获得各目标更多的特征估计,例如可从目标观测的稀疏点量测集中提取各目标的形状轮廓信息,这对目标的深度识别具有极其重要的现实意义。但是,由于METT中每个目标对应了多个量测,目标与量测之间的关联关系更加模糊和不确定,为METT的实现过程带来很大的挑战。另外,METT中借助传感器控制技术进行跟踪优化,需要在最优决策中考虑更多的特征优化(如形状估计的优化),这对科学制定传感器控制的最优任务准则提出了更为综合的要求。
鉴于此,本文利用随机矩阵(Random Matrix, RM)将扩展目标的形状轮廓建模为椭圆,这能够合理有效地描述扩展目标的大小和方向信息,将多扩展目标建模为多伯努利随机集,通过控制多扩展目标多特征的后验离差最小,使算法在优化多扩展目标运动状态估计的同时,也优化了目标形状的估计,最后采用伽马高斯逆威沙特多伯努利(Gamma Gaussian Inverse Wishart Multi-Bernoulli, GGIW-MBer)滤波器实现本文提出的多扩展目标跟踪中的传感器控制策略。值得一提的是,本文所提出的基于广义离差的优化准则也可拓展在基于多特征距离的复杂优化问题上。本文的主要贡献为:给出了加权广义最优子模式分配(Weighted Generalized Optimal Sub-Pattern Assignment, WGOSPA)距离构造多目标多特征估计的广义离差,同时研究提出了多特征融合下的传感器控制最优决策方法,优化了多扩展目标跟踪系统的整体性能。本文所提传感器控制方法的基本原理如图1所示。
2. 多扩展目标的随机集模型
假设
k−1 时刻多扩展目标的状态集合为ξk−1={ξ(i)k−1}Nξ,k−1i=1ξ(i)k−1 = (γ(i)k−1,x(i)k−1,X(i)k−1) (1) 其中,
ξk−1 表示k−1 时刻所有扩展目标的参数集,ξ(i)k−1 表示其中第i 个目标的参数集,该集合中的元素包括量测率γ(i)k−1 、运动状态x(i)k−1 和扩展状态X(i)k−1 。第
i 个扩展目标的运动状态模型为x(i)k=Fk|k−1x(i)k−1+w(i)k (2) 其中,
Fk|k−1 为状态转移矩阵,w(i)k 表示均值为零的高斯过程噪声,其协方差为Qk 。第
i 个目标的扩展状态由椭圆描述,用正定对称矩阵X(i)k 表示,即X(i)k=M(φ(i)k)((σ(i)k,1)200(σ(i)k,2)2)MT(φ(i)k) (3) M(φ(i)k)=(cos(φ(i)k)−sin(φ(i)k)sin(φ(i)k)cos(φ(i)k)) (4) 其中,目标轮廓的大小由扩展状态
X(i)k 的特征值(σ(i)k,1)2 和(σ(i)k,2)2 (椭圆半轴的2次方)确定,目标的方向角由旋转矩阵M(φ(i)k) 确定。k 时刻监控区域中所有扩展目标的量测集为Zk={z(j)k}Nz,kj=1=Θk(ξk)⋃Kk (5) 其中,
Θk(ξk) 为传感器检测到来自扩展目标的量测集,Kk 为杂波集,且杂波数服从参数为λk 的泊松分布。若z(j)k∈Θk(ξk) ,则z(j)k=h(x(i)k,xs,k(u))+e(j)k (6) 其中,
e(j)k 表示均值为零的高斯量测噪声,其协方差为X(i)k ,xs,k(u) 为k 时刻传感器控制方案u 对应的传感器位置。3. 传感器控制策略
3.1 多扩展目标跟踪中的传感器控制问题
控制量测过程最优是提高多扩展目标跟踪精度的有效方法,因此传感器控制问题即变为控制命令(或称为控制方案)子集的决策问题。考虑基于随机矩阵的多扩展目标跟踪建模,传感器控制决策必要的相关要素包括以下内容:
(1) 后验密度
fk−1+H(ξk−1+H|Z1:k−1+H) ;(2) 可实现传感器动作的控制命令集
Uk ;(3) 传感器控制评价函数
V(u) 。首先要以合理的方式建立传感器可控集合,在每个时刻传感器沿
Nθ 个方向中的某一个方向步进一到两个单位的距离,或者保持静止不动。考虑到0<Nθ<∞ ,且要保证传感器能够快速精准地运动到最佳观测点,因此取Nθ=8 ,如图2所示。图中,五角星代表当前时刻传感器的位置,其他点(含五角星)均代表下一时刻传感器可能的位置。H 增大会导致递推过程的不确定性,本文选用经典的“近视”策略(H=1 )。在传感器动作空间中,每个方案u 都有一个对应的评价函数V(u) ,它能够评估传感器控制方案的优劣。以下研究构造多扩展目标后验密度在其统计平均周围的广义离差作为评价函数,令其表达式为V(u)=D(fk(ξk|Z1:k−1,Zk(u))) (7) 其中,
D(⋅) 表示多扩展目标状态的后验密度在其统计平均周围的广义离差,它能反映综合多特征估计信息的整体质量。由式(7)可以看出,评价函数是传感器动作后,关于未来量测信息的函数,而这组量测信息显然不可预知,通用的解决方法是为每个可能的传感器动作生成一组伪量测,即预测理想量测集(Prediction Ideal Measurement Set, PIMS)[16,29]。若用
ˆuk 表示最优的传感器控制方案,则最终用式(8)确定该方案ˆuk=argminu∈UkE[V(u)] (8) 3.2 多特征广义离差的度量函数
由于需要考虑多扩展目标综合多特征(运动状态、形状等)估计的联合优化,制定合适的评价函数是多扩展目标跟踪传感器控制的核心问题。本文拟研究构造多扩展目标多特征估计在其后验统计均值周围的广义离差来评估传感器控制。为此,本文将给出一种 WGOSPA距离,该指标能够以合理的方式惩罚检测到的目标定位错误以及由于遗漏或假目标而产生的错误,鼓励滤波器尽可能少地产生估计错误和遗漏,同时,该指标能够综合多扩展目标的估计特征,以在多特征融合的条件下综合评判多扩展目标跟踪滤波性能。
(1) 广义最优子模式分配距离。令
c>0 ,0<α≤2 ,1≤p<∞ 。设d(x,y) 表示x,y∈RN 的某种距离度量,d(c)(x,y)=min(d(x,y),c) 。集合{1,2,⋯,n},n∈N 的所有排列方式记为Πn ,任意元素χ∈Πn 代表(χ(1),χ(2),⋯,χ(n)) 。设X 与Y 为RN 的有限子集。若|X|≤|Y| ,则X 与Y 的广义最优子模式分配距离[30]为d(c,α)p(X,Y)=[minχ∈Π|Y||X|∑i=1d(c)(xi,yχ(i))p+cpα(|Y|−|X|)]1p (9) 其中,
c 表示目标势估计平均距离误差,α 为势误差惩罚因子,p 表示位置误差与势误差的阶数,若|X|>|Y| ,则d(c,α)p(X,Y)=d(c,α)p(Y,X) 。(2) 加权广义最优子模式分配距离。多扩展目标真实的状态集合为
ξ(j)k ,估计的状态集合为ˆξ(i)k ,令d(ξ(j)k,ˆξ(i)k)=wγcγd(cγ)j,i+wxcxd(cx)j,i+wXcXd(cX)j,i (10) 其中,
wγ+wx+wX=1 ,d(cγ)j,i=min(cγ,|γ(j)k−ˆγ(i)k|) (11) d(cx)j,i=min(cx,‖x(j)k−ˆx(i)k‖2) (12) d(cX)j,i=min(cX,‖X(j)k−ˆX(i)k‖F) (13) 其中,
cγ ,cx 和cX 分别表示量测率、目标运动状态以及扩展状态的截断系数(最大期望误差),|⋅| 表示绝对值,‖⋅‖2 表示欧几里得范数,‖⋅‖F 表示弗罗贝尼乌斯范数。可以通过调整不同状态参数对应的权重大小来重点表达相应状态参数的后验离差,该离差作为传感器控制的评价函数在控制策略中表现为重点优化目标某种状态特征的估计效果。令
cw > 0 ,M=|ξ(j)k| ,N=|ˆξ(i)k| ,若M≤N ,则ξ(j)k 与ˆξ(i)k 的WGOSPA距离为d(cw,α)p(ξ(j)k,ˆξ(i)k)=[minπ∈ΠNM∑i=1d(ξ(j)k,ˆξ(i)k)p+(cw)pα(N−M)]1p (14) 若
M>N ,则d(cw,α)p(ξ(j)k,ˆξ(i)k)=d(cw,α)p(ˆξ(i)k,ξ(j)k) 。值得注意的是,由于式(9)是严格意义上的距离(证明过程见文献[30]),而式(10)也是严格意义上的距离,因此WGOSPA距离亦符合严格意义上的距离的定义。
3.3 评价函数的构建与最优数值求解
已知
k−1 时刻多扩展目标的后验密度fk−1(⋅|⋅) ,根据多扩展目标跟踪滤波器进行预测,得到k 时刻预测的多扩展目标密度fk|k−1(⋅|⋅) ,然后提取预测状态(注:Sef 表示状态提取操作)ˆξk|k−1=Sef{fk|k−1(⋅|⋅)} (15) 在传感器的检测概率
pD(ξk)=1 且在零杂波和零噪声的理想情况下,根据ˆξk|k−1 为每一个可能的传感器控制方案u 构造多扩展目标PIMSZk(u)=⋃u∈Uk{h(ˆξk|k−1,xs,k(u))} (16) 利用
Zk(u) 对fk|k−1(⋅|⋅) 进行伪更新,进而得到传感器控制方案u 对应的伪更新后验多扩展目标密度fk,u(⋅|⋅) ,然后提取多扩展目标后验状态ξk,u=Sef{fk,u(⋅|⋅)} (17) 用
d(cw,α)p(ξk,u,E[ξk,u]) 表示ξk,u 和E[ξk,u] 之间的后验广义离差,则评价函数构造为V(u)=E[d(cw,α)p(ξk,u,E[ξk,u])] (18) 利用序贯蒙特卡罗(Sequential Monte Carlo, SMC)方法计算式(18)的数值为
V(u)=∫d(cw,α)p(ξk,u,E[ξk,u])fk,u(ξk,u)δξk,u=∫d(cw,α)p(ξk,u,ˉξk,u)1LL∑i=1δξ(i)k,u(ξk,u)δξk,u=1LL∑i=1d(cw,α)p(ξ(i)k,u,ˉξk,u) (19) 4. GGIW-MBer实现
假设
k−1 时刻第i 个目标的运动状态x(i)k−1 服从高斯分布f(x(i)k−1|X(i)k−1,Z1:k−1)=N(x(i)k−1;m(i)k−1,P(i)k−1) (20) 其中,
m(i)k−1 和P(i)k−1 分别为x(i)k−1 的均值和协方差阵。假设
k−1 时刻第i 个目标的扩展状态X(i)k−1 服从逆威沙特分布f(X(i)k−1|Z1:k−1)=IW(X(i)k−1;v(i)k−1,V(i)k−1) (21) 其中,
v(i)k−1 与V(i)k−1 分别为逆威沙特分布的自由度和逆尺度矩阵,d 为X(i)k−1 的维数。第
i 个目标的扩展状态转移密度由威沙特密度表示为f(X(i)k|X(i)k−1)=W(X(i)k;n,X(i)k−1n) (22) 自由度
n 描述了状态演化的不确定性。假设第
i 个目标的量测率几乎不随时间变化, 即γ(i)k=γ(i)k−1 (23) 量测率通常取决于目标的大小和位置,服从参数为
α(i)k 和β(i)k 的伽马分布。因此,单个目标的共轭先验是伽马高斯逆威沙特分布,表示为
fk|k(⋅|⋅)=G(r(i)k;α(i)k,β(i)k)N(x(i)k;m(i)k,P(i)k)×IW(X(i)k;v(i)k,V(i)k)≜GGIW(ξ(i)k;ζ(i)k) (24) 由多伯努利随机集的贝叶斯滤波可以得到如下的GGIW-MBer滤波过程:
将GGIW-MBer预测过程和更新过程应用于算法1中,即可实现本文所提的传感器控制,如算法2和算法3所示。
算法1 多扩展目标跟踪基于多特征优化的传感器控制算法 输入:k−1时刻多扩展目标多特征信息ζk−1与传感器坐标
xs,k−1,其中,ζk−1={αk−1,βk−1,mk−1,Pk−1,vk−1,Vk−1}。 (1) 多扩展目标跟踪的预测过程,得到fk|k−1(⋅|⋅)。 (2) 传感器控制 ˆξk|k−1=Sef{fk|k−1(⋅|⋅)}, 确定所有可能的控制方案Uk。 for all u∈Uk do 生成PIMS:Zk(u), 量测集划分:ρ∠Zk(u), 计算伪更新后验密度fk,u(⋅|⋅), 提取状态的统计平均:ˉξk,u←Sef{fk,u(⋅|⋅)}, 蒙特卡罗采样:{ξk,l}Ll=1←MC(fk,u(⋅|⋅),L), V(u)←0, for l=1:L V(u)←V(u)+1Ld(cw,α)p(ξk,l,ˉξk,u)。 end for end for
ˆuk←argminu∈UkV(u)。(3) 多扩展目标跟踪的更新过程,得到fk|k(⋅|⋅)。 (4) 提取状态信息ξk,并计算目标势Nk=|ξk|。 输出:目标势Nk,多扩展目标状态集ξk,k时刻传感器坐标
xs,k。算法2 GGIW-MBer预测过程 输入:ζ(i,j)k−1。 预测第j个GGIW分量的参数: m(i,j)k|k−1=Fk|k−1m(i,j)k−1 P(i,j)k|k−1=Fk|k−1P(i,j)k−1FTk|k−1+Qk v(i,j)k|k−1=e−Tsτv(i,j)k−1 V(i,j)k|k−1=v(i,j)k|k−1−d−1v(i,j)k−1−d−1V(i,j)k−1 X(i,j)k|k−1=V(i,j)k|k−1v(i,j)k|k−1−2d−2 α(i,j)k|k−1=α(i,j)k−1ηk−1 β(i,j)k|k−1=β(i,j)k−1ηk−1 输出:ζ(i,j)k|k−1。 算法3 GGIW-MBer更新过程 输入:ζ(i,j)k|k−1,量测集划分W。 更新第j个GGIW分量的参数:
ˉzWk=1|W|∑z(i)k∈Wz(i)kX(i,j)k|k−1=V(i,j)k|k−1v(i,j)k|k−1−2d−2 S(i,j,W)k|k−1=HkP(i,j)k|k−1HTk+X(i,j)k|k−1|W| K(i,j,W)k|k−1=P(i,j)k|k−1HTk(S(i,j,W)k|k−1)−1 ε(i,j,W)k|k−1=ˉzWk−Hkm(i,j)k|k−1 m(i,j)k=m(i,j)k|k−1+K(i,j,W)k|k−1ε(i,j,W)k|k−1 P(i,j)k=P(i,j)k|k−1−K(i,j,W)k|k−1S(i,j,W)k|k−1(K(i,j,W)k|k−1)T ZWk=∑z(i)k∈W(z(i)k−ˉzWk)(z(i)k−ˉzWk)T N(i,j,W)k|k−1=(X(i,j)k|k−1)12(S(i,j,W)k|k−1)−12ε(i,j,W)k|k−1 ×(ε(i,j,W)k|k−1)T⋅((S(i,j,W)k|k−1)−12)T((X(i,j)k|k−1)12)T v(i,j,W)k=v(i,j,W)k|k−1+|W| V(i,j,W)k=V(i,j,W)k|k−1+N(i,j,W)k|k−1+ZWk
X(i,j,W)k=V(i,j,W)kv(i,j,W)k−2d−2α(i,j,W)k=α(i,j,W)k|k−1+|W| β(i,j,W)k=β(i,j,W)k|k−1+1 输出:ζ(i,j)k。 5. 实验论证
5.1 参数设定
为了测试本文算法对密集多扩展目标跟踪优化效果,在监控区域内设有10个椭圆形扩展目标,建立动态跟踪环境,验证本文提出方法的有效性。实验中,GOSPA距离的参数设置为
p=1 ,c=2 ,α=2 。WGOSPA距离的参数设置为cw=2 ,cγ=5 ,cx=10 ,cX=10 ,wγ=0.1 ,wx=0.7 ,wX=0.2 。 采样间隔Ts=1 s ,遗忘因子ηk=8 ,杂波平均数设置为λFA=5 ,目标的检测概率和存活概率分别为pD=0.99 和pS=0.99 ,GGIW分量的最大数量为Jmax=100 ,时间衰减常数τ=5 s 。椭圆扩展目标的长半轴和短半轴的长度分别设定为A=6 m ,a=3 m ,方向角设为45°。每个采样周期内的量测个数服从参数为λ=15 的泊松分布。目标的运动模型以及量测模型如式(2)和式(6)所示,其中,Fk|k−1=[1Ts01]⊗Id,Hk=[10]⊗Id (25) Qk=Σ2(1−e−2Tst)[01]⊗Id (26) 其中,
t=1 s ,Σ 取0.1,⊗ 为克罗内克积的运算符。新生目标数JΓ,k=10 ,第j 个新生目标的权重w(j)Γ,k=0.1 ,其他参数初始化为m(j)Γ,k=(m(j)0)T,P(j)Γ,k=[10025]⊗Id (27) v(j)Γ,k=7,V(j)Γ,k=eye(d) (28) α(j)Γ,k=20,β(j)Γ,k=1 (29) k 时刻传感器所有可能的位置集合Uk 为Uk={(xs,k−1+rvsTsNRcos2πlNθ,ys,k−1+rvsTsNRsin2πlNθ)} (30) 其中,
xs,k−1=[xs,k−1ys,k−1]T 为k−1 时刻传感器的位置,r=1,2,⋯,NR ,l=1,2,⋯,Nθ ,仿真实验中,NR=2 ,Nθ=8 ,传感器运动的径向速度设为vs=10 m/s ,初始位置为xs,0=[00]T 。5.2 多扩展目标跟踪优化分析
本节将选用不同的控制方案与本文提出的控制方法进行比较。其中,方案1是基于柯西-施瓦茨散度[14]的传感器控制;方案2为本文提出的传感器控制方案。目标的初始参数见表1,真实轨迹见图3。
表 1 多扩展目标初始参数目标 出生时刻
(s)消亡时刻
(s)初始状态
(m; m; m/s; m/s)1 1 40 [–800; 600; 40; –15] 2 11 40 [–700; 0; 40; –10] 3 21 30 [–100; 500; –35; –20] 4 1 10 [200; 100; 10; 20] 5 1 20 [–500; 100; –15; –15] 6 31 40 [–100; 100; 20; –15] 7 6 15 [500; 300; 10; 10] 8 16 25 [–200; 300; –20; –60] 9 26 35 [–200; –300; 40; –15] 10 1 30 [300; –100; –20; –20] 图4记录了本文所提优化控制方案的传感器运动轨迹。从图中解读到,传感器自动按照多扩展目标多特征的后验密度广义离差最小化动态调节自身位置,使其在每个采样时刻都能获取最优量测过程。也注意到,目标个数发生突变的时刻,传感器的坐标也会产生明显的变化趋势,以应对由于多伯努利密度的瞬变带来的广义离差的瞬变,使传感器在最短时间内到达最优观测位置。
图5记录了100次独立的蒙特卡罗(Monte Carlo, MC)仿真实验中传感器经过的所有位置,可以看出,在相同的评价准则下由于受到环境随机因素的影响,每次MC仿真实验中的传感器运动轨迹存在一定差异。但是从图中还是可以反映出传感器优化运动所在的大致活跃区域,反映了传感器在多扩展目标跟踪系统中的最优观测轨迹的运动趋势。
图6为100次独立的MC仿真实验中多扩展目标质心位置估计的GOSPA距离统计,表2为各方案目标质心位置估计GOSPA距离的统计均值,综合图表可以分析出,本文方案对多扩展目标质心位置的估计效果是要优于方案1。
表 2 目标质心估计的GOSPA距离统计均值(m)方案1 方案2 GOSPA距离 1.1303 1.0671 为了比较清晰地对多目标形状轮廓估计效果进行比对,在图7呈现扩展目标跟踪估计的放大效果。可以分析得出,本文所提方法对目标形状的估计效果更加接近于实际,直观地体现出所提方法更好地优化了对目标扩展状态的估计。
扩展状态估计效果的优劣可由椭圆长短轴估计误差的大小来评估。鉴于此,统计得到MC实验中长短轴估计信息的GOSPA距离如图8,而表3是相应的统计平均值,由图表联合分析可得,本文方案对多扩展目标综合多特征估计的优化效果更优。
表 3 目标长短轴的GOSPA距离统计平均值(m)方案1 方案2 GOSPA距离 1.5594 1.5009 图9显示了MC仿真实验中多扩展目标势(即目标的个数)估计的统计效果,可以看出,所有传感器控制方案对目标势的估计差别并不大,由于GOSPA距离是综合评价指标(联合评价目标势和目标状态估计),结合前述各GOSPA距离统计的效果图,也突显了本文所提算法的优化效果着重体现在多扩展目标的多特征估计上。
6. 结束语
本文的主要工作和创新点是利用基于多特征距离广义离差最小化的传感器控制方法提出了一种有效的多扩展目标跟踪优化算法,使其对多扩展目标运动状态和形状的估计得到明显优化,通过仿真实验可知,各项跟踪性能指标均优于其他传感器控制方案,有效提升了多扩展目标跟踪系统的性能。所提算法的意义在于实现了多扩展目标的运动状态估计与扩展状态估计的联合优化,实现了多特征共同决策下的传感器最优控制技术,这对于精度要求更高的现代目标跟踪系统来说有着重要的理论价值。
-
算法1 多扩展目标跟踪基于多特征优化的传感器控制算法 输入:k−1时刻多扩展目标多特征信息ζk−1与传感器坐标
xs,k−1,其中,ζk−1={αk−1,βk−1,mk−1,Pk−1,vk−1,Vk−1}。 (1) 多扩展目标跟踪的预测过程,得到fk|k−1(⋅|⋅)。 (2) 传感器控制 ˆξk|k−1=Sef{fk|k−1(⋅|⋅)}, 确定所有可能的控制方案Uk。 for all u∈Uk do 生成PIMS:Zk(u), 量测集划分:ρ∠Zk(u), 计算伪更新后验密度fk,u(⋅|⋅), 提取状态的统计平均:ˉξk,u←Sef{fk,u(⋅|⋅)}, 蒙特卡罗采样:{ξk,l}Ll=1←MC(fk,u(⋅|⋅),L), V(u)←0, for l=1:L V(u)←V(u)+1Ld(cw,α)p(ξk,l,ˉξk,u)。 end for end for
ˆuk←argminu∈UkV(u)。(3) 多扩展目标跟踪的更新过程,得到fk|k(⋅|⋅)。 (4) 提取状态信息ξk,并计算目标势Nk=|ξk|。 输出:目标势Nk,多扩展目标状态集ξk,k时刻传感器坐标
xs,k。算法2 GGIW-MBer预测过程 输入:ζ(i,j)k−1。 预测第j个GGIW分量的参数: m(i,j)k|k−1=Fk|k−1m(i,j)k−1 P(i,j)k|k−1=Fk|k−1P(i,j)k−1FTk|k−1+Qk v(i,j)k|k−1=e−Tsτv(i,j)k−1 V(i,j)k|k−1=v(i,j)k|k−1−d−1v(i,j)k−1−d−1V(i,j)k−1 X(i,j)k|k−1=V(i,j)k|k−1v(i,j)k|k−1−2d−2 α(i,j)k|k−1=α(i,j)k−1ηk−1 β(i,j)k|k−1=β(i,j)k−1ηk−1 输出:ζ(i,j)k|k−1。 算法3 GGIW-MBer更新过程 输入:ζ(i,j)k|k−1,量测集划分W。 更新第j个GGIW分量的参数:
ˉzWk=1|W|∑z(i)k∈Wz(i)kX(i,j)k|k−1=V(i,j)k|k−1v(i,j)k|k−1−2d−2 S(i,j,W)k|k−1=HkP(i,j)k|k−1HTk+X(i,j)k|k−1|W| K(i,j,W)k|k−1=P(i,j)k|k−1HTk(S(i,j,W)k|k−1)−1 ε(i,j,W)k|k−1=ˉzWk−Hkm(i,j)k|k−1 m(i,j)k=m(i,j)k|k−1+K(i,j,W)k|k−1ε(i,j,W)k|k−1 P(i,j)k=P(i,j)k|k−1−K(i,j,W)k|k−1S(i,j,W)k|k−1(K(i,j,W)k|k−1)T ZWk=∑z(i)k∈W(z(i)k−ˉzWk)(z(i)k−ˉzWk)T N(i,j,W)k|k−1=(X(i,j)k|k−1)12(S(i,j,W)k|k−1)−12ε(i,j,W)k|k−1 ×(ε(i,j,W)k|k−1)T⋅((S(i,j,W)k|k−1)−12)T((X(i,j)k|k−1)12)T v(i,j,W)k=v(i,j,W)k|k−1+|W| V(i,j,W)k=V(i,j,W)k|k−1+N(i,j,W)k|k−1+ZWk
X(i,j,W)k=V(i,j,W)kv(i,j,W)k−2d−2α(i,j,W)k=α(i,j,W)k|k−1+|W| β(i,j,W)k=β(i,j,W)k|k−1+1 输出:ζ(i,j)k。 表 1 多扩展目标初始参数
目标 出生时刻
(s)消亡时刻
(s)初始状态
(m; m; m/s; m/s)1 1 40 [–800; 600; 40; –15] 2 11 40 [–700; 0; 40; –10] 3 21 30 [–100; 500; –35; –20] 4 1 10 [200; 100; 10; 20] 5 1 20 [–500; 100; –15; –15] 6 31 40 [–100; 100; 20; –15] 7 6 15 [500; 300; 10; 10] 8 16 25 [–200; 300; –20; –60] 9 26 35 [–200; –300; 40; –15] 10 1 30 [300; –100; –20; –20] 表 2 目标质心估计的GOSPA距离统计均值(m)
方案1 方案2 GOSPA距离 1.1303 1.0671 表 3 目标长短轴的GOSPA距离统计平均值(m)
方案1 方案2 GOSPA距离 1.5594 1.5009 -
[1] SHIN D, SONG Y, OH J, et al. Nonlinear disturbance observer-based standoff target tracking for small fixed-wing UAVs[J]. International Journal of Aeronautical and Space Sciences, 2021, 22(1): 108–119. doi: 10.1007/s42405-020-00275-6 [2] KIM D Y, VO B N, VO B T, et al. A labeled random finite set online multi-object tracker for video data[J]. Pattern Recognition, 2019, 90: 377–389. doi: 10.1016/j.patcog.2019.02.004 [3] 陈辉, 邓东明, 韩崇昭. 基于区间箱粒子多伯努利滤波器的传感器控制策略[J]. 自动化学报, 2021, 47(6): 1428–1443. doi: 10.16383/j.aas.c180541CHEN Hui, DENG Dongming, and HAN Chongzhao. Sensor control based on interval box-particle multi-Bernoulli filter[J]. Acta Automatica Sinica, 2021, 47(6): 1428–1443. doi: 10.16383/j.aas.c180541 [4] 陈辉, 李国财, 韩崇昭, 等. 高斯过程回归模型多扩展目标多伯努利滤波器[J]. 控制理论与应用, 2020, 37(9): 1931–1943. doi: 10.7641/CTA.2020.90978CHEN Hui, LI Guocai, HAN Chongzhao, et al. A multiple extended target multi-Bernouli filter based on Gaussian process regression model[J]. Control Theory &Applications, 2020, 37(9): 1931–1943. doi: 10.7641/CTA.2020.90978 [5] CORALUPPI S, CARTHEL C, KREAMER W, et al. New graph-based and MCMC approaches to multi-INT surveillance[C]. The 19th International Conference on Information Fusion (FUSION), Heidelberg, Germany, 2016: 394–401. [6] BOSTRÖM-ROST P, AXEHILL D, and HENDEBY G. PMBM filter with partially grid-based birth model with applications in sensor management[J]. IEEE Transactions on Aerospace and Electronic Systems, 2022, 58(1): 530–540. doi: 10.1109/TAES.2021.3103255 [7] HERO A O and COCHRAN D. Sensor management: Past, present, and future[J]. IEEE Sensors Journal, 2011, 11(12): 3064–3075. doi: 10.1109/JSEN.2011.2167964 [8] 陈辉, 韩崇昭. 机动多目标跟踪中的传感器控制策略的研究[J]. 自动化学报, 2016, 42(4): 512–523. doi: 10.16383/j.aas.2016.c150529CHEN Hui and HAN Chongzhao. Sensor control strategy for maneuvering multi-target tracking[J]. Acta Automatica Sinica, 2016, 42(4): 512–523. doi: 10.16383/j.aas.2016.c150529 [9] 罗开平, 姜维, 李一军. 传感器管理述评[J]. 电子学报, 2010, 38(8): 1900–1907.LUO Kaiping, JIANG Wei, and LI Yijun. Review of sensor management[J]. Acta Electronica Sinica, 2010, 38(8): 1900–1907. [10] MAHLER R P S. Advances in Statistical Multisource-Multitarget Information Fusion[M]. Boston: Artech House, 2014: 825–860. [11] MAHLER R P S. Statistical Multisource-Multitarget Information Fusion[M]. Boston: Artech House, 2007: 655–667. [12] 杨威, 付耀文, 龙建乾, 等. 基于有限集统计学理论的目标跟踪技术研究综述[J]. 电子学报, 2012, 40(7): 1440–1448. doi: 10.3969/j.issn.0372-2112.2012.07.025YANG Wei, FU Yaowen, LONG Jianqian, et al. The FISST-based target tracking techniques: A survey[J]. Acta Electronica Sinica, 2012, 40(7): 1440–1448. doi: 10.3969/j.issn.0372-2112.2012.07.025 [13] AUGHENBAUGH J M and LA COUR B R. Metric selection for information theoretic sensor management[C]. The 11th International Conference on Information Fusion, Cologne, Germany, 2008: 1–8. [14] HOANG H G, VO B N, VO B T, et al. The Cauchy–Schwarz divergence for Poisson point processes[J]. IEEE Transactions on Information Theory, 2015, 61(8): 4475–4485. doi: 10.1109/TIT.2015.2441709 [15] 陈辉, 贺忠良, 邓东明, 等. 高斯混合多伯努利滤波器基于柯西施瓦兹散度的传感器控制方法[J]. 电子学报, 2020, 48(4): 706–716. doi: 10.3969/j.issn.0372-2112.2020.04.012CHEN Hui, HE Zhongliang, DENG Dongming, et al. Sensor control using Cauchy-Schwarz divergence via Gaussian mixture multi-Bernoulli filter[J]. Acta Electronica Sinica, 2020, 48(4): 706–716. doi: 10.3969/j.issn.0372-2112.2020.04.012 [16] RISTIC B, VO B N, and CLARK D. A note on the reward function for PHD filters with sensor control[J]. IEEE Transactions on Aerospace and Electronic Systems, 2011, 47(2): 1521–1529. doi: 10.1109/TAES.2011.5751278 [17] 陈辉, 贺忠良, 连峰, 等. 多目标跟踪中基于目标威胁度评估的传感器控制方法[J]. 电子与信息学报, 2018, 40(12): 2861–2867. doi: 10.11999/JEIT180212CHEN Hui, HE Zhongliang, LIAN Feng, et al. Threat assessment based sensor control for multi-target tracking[J]. Journal of Electronics &Information Technology, 2018, 40(12): 2861–2867. doi: 10.11999/JEIT180212 [18] KATSILIERIS F, DRIESSEN H, and YAROVOY A. Threat-based sensor management for target tracking[J]. IEEE Transactions on Aerospace and Electronic Systems, 2015, 51(4): 2772–2785. doi: 10.1109/TAES.2015.140052 [19] HOANG H G and VO B T. Sensor management for multi-target tracking via multi-Bernoulli filtering[J]. Automatica, 2014, 50(4): 1135–1142. doi: 10.1016/j.automatica.2014.02.007 [20] GOSTAR A K, HOSEINNEZHAD R, and BAB-HADIASHAR A. Multi-Bernoulli sensor control via minimization of expected estimation errors[J]. IEEE Transactions on Aerospace and Electronic Systems, 2015, 51(3): 1762–1773. doi: 10.1109/TAES.2015.140211 [21] MAHLER R P S and ZAJIC T R. Probabilistic objective functions for sensor management[J]. SPIE, 2004, 233–244. [22] KOCH J W. Bayesian approach to extended object and cluster tracking using random matrices[J]. IEEE Transactions on Aerospace and Electronic Systems, 2008, 44(3): 1042–1059. doi: 10.1109/TAES.2008.4655362 [23] FELDMANN M, FRÄNKEN D, and KOCH W. Tracking of extended objects and group targets using random matrices[J]. IEEE Transactions on Signal Processing, 2011, 59(4): 1409–1420. doi: 10.1109/TSP.2010.2101064 [24] TUNCER B and ÖZKAN E. Random matrix based extended target tracking with orientation: A new model and inference[J]. IEEE Transactions on Signal Processing, 2021, 69: 1910–1923. doi: 10.1109/TSP.2021.3065136 [25] BAUM M and HANEBECK U D. Random hypersurface models for extended object tracking[C]. 2009 IEEE International Symposium on Signal Processing and Information Technology (ISSPIT), Ajaman, United Arab Emirates, 2009: 178–183. [26] WAHLSTRÖM N and ÖZKAN E. Extended target tracking using Gaussian processes[J]. IEEE Transactions on Signal Processing, 2015, 63(16): 4165–4178. doi: 10.1109/TSP.2015.2424194 [27] 陈辉, 杜金瑞, 韩崇昭. 基于星凸形随机超曲面模型多扩展目标多伯努利滤波器[J]. 自动化学报, 2020, 46(5): 909–922. doi: 10.16383/j.aas.c180130CHEN Hui, DU Jinrui, and HAN Chongzhao. A multiple extended target multi-bernouli filter based on star-convex random hypersurface model[J]. Acta Automatica Sinica, 2020, 46(5): 909–922. doi: 10.16383/j.aas.c180130 [28] MAHLER R. PHD filters for nonstandard targets, I: Extended targets[C]. The 12th International Conference on Information Fusion, Seattle, USA, 2009: 915–921. [29] GOSTAR A K, HOSEINNEZHAD R, BAB-HADIASHAR A, et al. Sensor-management for multitarget filters via minimization of posterior dispersion[J]. IEEE Transactions on Aerospace and Electronic Systems, 2017, 53(6): 2877–2884. doi: 10.1109/TAES.2017.2718280 [30] RAHMATHULLAH A S, GARCÍA-FERNÁNDEZ Á F, and SVENSSON L. Generalized optimal sub-pattern assignment metric[C]. The 20th International Conference on Information Fusion (Fusion), Xi’an, China, 2017: 1–8. -