专利摘要
本发明公开了一种自适应目标新生强度的PHD平滑器的多目标跟踪方法,主要解决在杂波环境下,自适应目标新生强度的PHD滤波器在目标新生时刻存在目标确认的滞后现象,并给出其线性高斯条件下的实现形式。通过前向滤波和后向平滑,能够准确估计目标数目和状态,减小目标新生时确认滞后对航迹形成带来的影响。其步骤包括目标新生率估计、前向滤波和后向平滑,即首先根据先验杂波数均值来估计k时刻的新生率;其次,采用k时刻的量测对目标进行预测和更新来完成前向滤波;然后,用滞后的L时刻量测对滤波结果进行后向平滑;最后,通过修剪合并和状态提取完成跟踪结果的输出。
权利要求
1.一种自适应目标新生强度的PHD平滑器的多目标跟踪方法,包括如下步骤:
(1)对k-1时刻跟踪滤波器中存活目标的PHD的高斯混合形式
(2)根据先验杂波信息对新生目标强度估计:
2a)根据k时刻传感器的测量方差Σk/k-1、杂波检测概率pD(c)、目标检测概率pD(t)、目标存活概率pS(t)、先验杂波数均值N(c)、目标新生权值门限Te和监控区域体积VS信息来估计k时刻的目标新生率λb,k;
2b)根据估计的目标新生率λb,k和量测数据zk,把新生目标的PHD中的高斯项 加入到k-1时刻跟踪结果的全体目标的高斯项中,完成对监测区域内新生目标强度的检测,式中wb,k(i)=λb,k,wb,k,mb,k,Pb,k分别对应新生目标高斯项的权值,均值,方差;
(3)前向滤波,包括PHD预测和PHD更新:
3a)PHD预测:对k-1时刻的全体目标PHD向k时刻进行预测,其中全体目标包括存活目标和新生目标;
3b)PHD更新:利用k时刻的量测数据zk,对预测PHD中的新生目标Dk/k-1(y,1)和存活目标Dk/k-1(y,0)分别进行更新,得到前向滤波结果 其中wf,k,mf,k,Pf,k分别对应前向滤波后的高斯项权值,均值,方差;
(4)后向平滑:利用滞后的L时刻的量测信息zL来平滑前向滤波后的高斯项,得到后向平滑结果 其中wk/L,mk/L,Pk/L分别对应后向平滑后的高斯项的权值,均值,方差;当L=k+1时为一步后向平滑;
(5)删剪合并高斯项:对平滑后权值小于经验门限Tprun的高斯项进行删剪,对均值mk(i)之间的距离小于门限Umerg的高斯项进行合并,得到删剪合并后的状态估计结果 其中wk(i),mk(i),Pk(i)分别对应删剪合并后的高斯项权值,均值,方差;
(6)估计全体目标数目:对修剪合并后的PHD进行权值求和 得到全体目标数目估计
(7)输出最终的状态估计 和目标数估计结果 得到多目标跟踪的结果。
2.根据权利要求1所述的自适应目标新生强度的PHD平滑器的多目标跟踪方法,其特征在于:步骤(2)所述的目标新生率 的估计计算式为:
式中Σk/k-1为传感器的测量方差,pD,k(c),pD,k(t)分别为杂波和目标的检测概率,pS,k(t)为目标的存活概率,N(c)为先验杂波数均值,VS为监控区域体积,Te为新生一个目标的新生权值门限, 表示目标新生率λb,k的估计值。
3.根据权利要求1所述的自适应目标新生强度的PHD平滑器的多目标跟踪方法,其特征在于:步骤(4)所述的根据L时刻的量测信息对k时刻全体目标的前向滤波后的高斯项进行平滑,得到k时刻的状态估计,全体目标包括存活目标和新生目标,其中PHD平滑的计算式为:
其中yk为k时刻目标的可观测状态,Z1:k为1到k时刻的量测集合,pS,k+1/k为存活概率,Dk/k(yk|Z1:k)为k时刻存活目标和新生目标的PHD滤波结果,Fk+1/k(yk+1|yk)为k-1到k时刻的状态转移函数,Dk+1/k(yk+1|Z1:k)为k到k+1时刻存活目标和新生目标的PHD预测,Dk+1/L(yk+1|Z1:k)为L向k+1时刻存活目标和新生目标的后向递推结果。
说明书
技术领域
本发明属于雷达信号处理技术领域,涉及多目标跟踪。具体地说是一种自适应目标新生强度的概率假设密度平滑器(λ-ATBI-PHDSmoother)的多目标跟踪方法,可用于杂波环境下的火控、航管等探测系统中。
背景技术
无论现代的防御探测还是空中交通管制ATC(AirTrafficControl)系统中,多目标跟踪MTT(MutipleTargetTracking)都是其中的关键技术,也是历来受到最多关注的方向之一。多目标环境下的跟踪问题,存在以下难点:(1)每一时刻都可能存在目标的出现、衍生以及消失,使得目标数目处在一个不断变化的过程中;(2)量测信息不确定,若对漏检、虚警等问题处理不当,将会极大地影响跟踪效果;(3)进行跟踪滤波的同时,还需要完成数据关联。
因此,在复杂环境下,存在的虚警、漏警等量测信息的不确定性和目标生灭带来的数目变化给多目标的稳定跟踪造成很大困难,一直是该领域的研究热点和难点。
传统的多目标跟踪需要进行数据关联,在目标和量测数目较多时计算量会急剧增大。近年来,Mahler等学者提出基于随机有限集(RandomFiniteSet,RFS)理论的多目标跟踪方法,并推导了PHD(ProbabilityHypothesisDensity,概率假设密度)、CPHD(CardinalisedProbabilityHypothesisDensity,势概率假设密度)、多伯努利等实现形式。该理论框架下,多目标的量测和状态分别被视为一个随机有限集,避免了复杂的数据关联,因此受到广泛的关注。
PHD滤波是通过递推目标状态的后验概率密度的一阶矩,可从中来估计多目标的状态和个数。PHD的实现方式有两种:高斯混合(GaussianMixture,GM)和粒子。在线性高斯条件下,高斯混合PHD(GM-PHD)利用加权的高斯混合分布来拟合目标的后验概率密度函数,状态提取不再需要进行聚类,可以用较小的计算量完成滤波估计。
在传统的PHD和CPHD滤波中,认为新生目标多出现在感兴趣的特定位置(例如:机场,视场的边界处等),新生目标的初始强度是作为先验已知量。而实际应用中,新生目标的初始强度是很难获得的,这给工程应用造成了困难。
B.Ristic等人于2012年提出了基于量测驱动的自适应目标新生强度概率假设密度滤波器(AdaptiveTargetBirthIntensityProbabilityHypothesisDensityFilter,ATBI-PHDFilter),即ATBI-PHD滤波器,能够从量测中估计目标新生强度并同时对新生目标和存活目标进行递推滤波,摆脱对新生强度先验的依赖,并将ATBI方法和多个固定点检测新生的方法进行了对比。LiangMa等人于2014年针对杂波环境下新生目标的快速生成,提出对PHD滤波器的目标新生率的估计方法,得到λ-ATBI-PHDFilter,即λ-ATBI-PHD滤波器。
但该方法在杂波环境下,自适应目标新生强度的PHD滤波器在目标新生时刻存在目标确认的滞后现象,即对新生目标出现时刻的估计存在延迟,对后续完整的目标航迹形成和关联造成影响。
发明内容
本发明为解决上述现有方法的问题,提出一种自适应目标新生强度的PHD平滑器的多目标跟踪方法,即λ-ATBI-PHD平滑器的多目标跟踪方法。本发明的主要方法:首先,根据先验杂波数均值来估计目标的新生率,能够在得到特定杂波数均值的情况下,尽快检测到新生目标;其次,通过后向平滑能够更加准确的估计目标出现时刻,减小目标新生时刻的确认滞后情况对后续航迹关联的影响,使得目标数目的估计更加准确。
本发明实现上述目的的技术方法包括如下步骤:
1)对k-1时刻跟踪滤波器中存活目标PHD的高斯混合形式
2)根据先验杂波信息对新生目标强度估计:
2a)根据k时刻传感器的测量方差Σk/k-1、杂波检测概率pD(c)、目标检测概率pD(t)、目标存活概率pS(t)、先验杂波数均值N(c)、目标新生权值门限Te和监控区域体积VS信息来估计k时刻的目标新生率λb,k;
2b)根据估计的目标新生率λb,k和量测数据zk,把新生目标的PHD中的高斯项 加入到k-1时刻跟踪结果的全体目标的高斯项中,完成对监测区域内新生目标强度的检测,式中wb,k(i)=λb,k,wb,k(i),mb,k(i),Pb,k(i)分别对应新生目标高斯项的权值,均值,方差;
3)前向滤波,包括PHD预测和PHD更新:
3a)PHD预测:对k-1时刻的全体目标PHD向k时刻进行预测,其中全体目标包括存活目标和新生目标;
3b)PHD更新:利用k时刻的量测数据zk,对预测PHD中的新生目标Dk/k-1(y,1)和存活目标Dk/k-1(y,0)分别进行更新,得到前向滤波结果 其中wf,k,mf,k,Pf,k分别对应前向滤波后的高斯项权值、均值、方差;
4)后向平滑:利用滞后的L时刻的量测信息zL来平滑前向滤波后的高斯项,得到后向平滑结果 其中wk/L,mk/L,Pk/L分别对应后向平滑后的高斯项权值,均值,方差,当L=k+1时为一步后向平滑;
5)删剪合并高斯项:对平滑后权值小于经验门限Tprun的高斯项进行删剪,对均值mk(i)之间的距离小于门限Umerg的高斯项进行合并,得到删剪合并后的状态估计结果 其中wk(i),mk(i),Pk(i)分别对应删剪合并后的高斯项权值,均值,方差;
6)估计全体目标数目:对修剪合并后的PHD进行权值求和 得到全体目标数目估计
7)输出最终的状态估计 和目标数估计结果 得到多目标跟踪的结果。
本发明与现有技术相比具有以下优点:
1.针对目标新生强度未知条件下,ATBI-PHD滤波器和λ-ATBI-PHD滤波器在目标新生时刻,对目标数的估计和目标确认存在滞后的这一问题提出了一种自适应目标新生强度的PHD平滑器,即λ-ATBI-PHD平滑器,分别对新生目标和存活目标进行前向滤波和后向平滑,给出了高斯混合条件下的实现形式。对于杂波环境下的多目标跟踪问题,由于PHD平滑器能够利用更多的滞后时间测量,因此相比于PHD滤波器,它在杂波密度较大以及传感器检测概率较低时可以有效提高多目标的个数和状态估计精度。
2.引入目标新生率估计方法,根据先验杂波强度来估计目标新生率,能够在得到特定杂波数均值的情况下,尽快检测到新生目标。
仿真结果表明,相较于ATBI-PHD滤波器、λ-ATBI-PHD滤波器,本发明的λ-ATBI-PHD平滑器能够更好的估计目标状态,更加准确的估计目标出现时刻,可以减小目标新生时确认的滞后对航迹生成的影响并准确估计目标数目。火控和航管等探测系统中常常需要获得准确的航迹信息,本发明的λ-ATBI-PHD平滑器在杂波环境下对于保证多目标跟踪精度和形成正确航迹方面具有积极的意义。
附图说明
图1是本发明方法的流程图
图2是传感器获得的量测数据图
图3是多目标跟踪的目标真实航迹
图4是ATBI-PHD滤波器经过50次蒙特卡洛仿真的跟踪结果
图5是λ-ATBI-PHD滤波器经过50次蒙特卡洛仿真的跟踪结果
图6是λ-ATBI-PHD平滑器经过50次蒙特卡洛仿真的跟踪结果
图7是多目标跟踪的目标数估计图
图8是多目标跟踪的OSPA距离误差图
具体实施方式
依据附图,对本发明的技术方案作具体说明。
本发明使用的量测和状态模型如下:
PHD滤波是将所有量测和目标状态看作两个随机有限集,分别为
Zk={zk,1,........,zk,m}∈F(Ζ)(1)
Ξk=Sk(Xk-1)∪Γk(Xk-1)∈F(χ)(2)
其中Zk为k时刻量测集合,Ξk为全体目标,Sk为存活目标,Γk为新生目标,F(Z)为量测随机有限集,F(χ)为目标状态的随机有限集,Xk-1为k-1时刻的目标状态。
在传感器每一时刻获得的量测是来自于目标或杂波,而全体目标的量测来源又可分为新生目标和存活目标。自适应目标新生强度方法是把目标的状态空间分为存活目标和新生目标,根据每一时刻的量测信息反演出可能的新生目标位置,同时对全体目标进行递推滤波,使得跟踪方法不再依赖已知目标新生强度的先验信息。
本发明中使用的平滑器分为前向滤波、后向平滑两个步骤。在前向滤波时,后验密度是贝叶斯递推的前向传播;在后向平滑时,利用滞后的L时刻的信息来更新k时刻的状态,完成多目标的后向平滑递推,其中k<L。
如附图1的流程图所示,本发明实现步骤如下:
1)对k-1时刻跟踪滤波器中存活目标PHD的高斯混合形式
用β=0,1来分别表示目标状态x中区分新生目标和存活目标的标志,即
用y表示目标状态x中可以观测到的部分,如目标位置、速度等;
2)根据先验杂波信息对新生目标强度估计:
2a)根据k时刻传感器的测量方差Σk/k-1、杂波检测概率pD(c)、目标检测概率pD(t)、目标存活概率pS(t)、先验杂波数均值N(c)、目标新生权值门限Te和监控区域体积VS信息来估计k时刻的目标新生率λb,k;
在杂波条件下,第j个量测的来源是杂波或目标,故PHD中第i个高斯项的预测值为:
其中pD,k(c),pD,k(t)分别为杂波和目标的检测概率,λb,k为目标新生率;
可以看出,预测的PHD中分为杂波的PHD、新生目标的PHD、存活目标的PHD三部分,pD,k(c)N(c)/VS为杂波部分,λb,k/VS为新生目标部分,pD,k(t)wk/k-1iqki,j为存活目标部分,qk(i,j)=N(zkj;Hmk/k-1(i),R+HPk/k-1(i)HT)为似然函数;
由于B.Ristic提出的自适应目标新生强度模型是假设新生目标强度在监测视场内满足均匀分布,并没有考虑杂波对目标新生的影响。由(4)式可以看出,当杂波数目均值N(c)增加时,新生部分所占的比例就会相应的下降,即新生目标初始强度降低,会造成目标新生时刻估计的滞后;当新生目标强度部分增加时,又会低估杂波数均值;
LiangMa提出了目标新生率的估计方法,其目标新生率估计式为:
将引入目标新生率估计的自适应目标新生强度的PHD滤波称为λ-ATBI-PHD滤波,通过对目标新生率的估计,可以根据杂波环境来设置新生目标的初始权值,能够在得到特定杂波数均值的情况下,使得新生目标在连续两帧数据出现后就可以被检测到;
2b)将估计的新生率 赋值给对应的新生高斯项权值wb(i),并根据量测数据把新生高斯项的参数wb,k(i),mb,k(i),Pb,k(i)赋值给 并把Dk-1/k-1(y,1)加入到原有的 中,完成对监测区域内新生目标的检测;
3)前向滤波:
3a)PHD预测:对全体目标的PHD进行预测,其中全体目标分为新生和存活两部分:
Dk/k-1(y,β)为预测的全体目标PHD强度,y和y’分别表示k和k-1时刻目标的可观测状态,ps(y,β)为目标的存活概率,fk/k-1为目标从k-1到k时刻的状态转移函数;
新生目标:Dk/k-1(y,1)=γk(y,1)=Σwb,kN(mb,k;Pb,k)(7)
式中γk(y,1)表示根据k时刻的量测反演的新生目标的强度;
存活目标:
由于γk(y,0)=0,故有
Dk/k-1(y,0)=<Dk-1/k-1(y,1)+Dk-1/k-1(y,0),ps(y',β')fk/k-1(y,β|y',β')>=<ps(y',1)Σwb,k-1N(mb,k-1;Pb,k-1)+ps(y',0)Σws,k-1N(ms,k-1;Ps,k-1),fk/k-1(y,β|y',β')>=Σwb,k/k-1N(mb,k/k-1;Pb,k/k-1)+Σws,k/k-1N(ms,k/k-1;Ps,k/k-1)
(8)
(8)式中
wb,k/k-1=wb,k-1ps(y',1)(8-1)
mb,k/k-1=Fkmb,k-1(8-2)
Pb,k/k-1=FkPb,k-1FkT(8-3)
ws,k/k-1=ws,k-1ps(y',0)(8-4)
ms,k/k-1=Fkms,k-1(8-5)
Ps,k/k-1=FkPs,k-1FkT+Q(8-6)
wb,k-1,mb,k-1,Pb,k-1和ws,k-1,ms,k-1,Ps,k-1分别为k-1时刻滤波结果中PHD的新生和存活部分的高斯项权值,均值,方差;
wb,k/k-1,mb,k/k-1,Pb,k/k-1和ws,k/k-1,ms,k/k-1,Ps,k/k-1分别为k-1时刻预测PHD的新生和存活部分的高斯项权值,均值,方差,Q为状态噪声协方差,Dk-1/k-1(y,0)=Σws,k-1N(ms,k-1;Ps,k-1)为k-1时刻的存活目标PHD;
3b)PHD更新:根据k时刻的量测数据zk,对预测PHD中的新生目标Dk/k-1(y,1)和存活目标Dk/k-1(y,0)分别进行更新:
其中Dk/k(y,β)为更新后的全体目标的PHD强度,gk(z|y,β)为目标的似然函数,κk(z)=N(i)/VS为监视区域内的杂波强度, 为得到的全体目标的PHD前向滤波结果,pD,k(y,β)为目标的检测概率,有
(9)式中
wm,k(i)=(1-PD,k)ws,k/k-1(i)(9-1)
均值mm,k(i),ms,k(i),mb,k(i)的更新式都形如 其中mk(i)=mm,k(i),ms,k(i),mb,k(i);
协方差Pm,k(i),Ps,k(i),Pb,k(i)的更新式都形如Pk(i)=[I-Kk(i)H]Pk/k-1(i),其中Pk(i)=Pm,k(i),Ps,k(i),Pb,k(i);
Kk(i)=Pk/k-1(i)HT[Sk/k-1(i)]-1(11)
Sk/k-1(i)=HPk/k-1(i)HT+R(12)
其中wm,k为更新后漏检部分权值,ws,k为更新后存活部分权值,wb,k为更新后新生部分权值,H为观测矩阵,R为观测噪声协方差,Kk(i)为卡尔曼滤波增益;
4)后向平滑:利用滞后的L时刻的量测信息zL来更新k时刻的状态,完成多目标的后向平滑递推,其中当L=k+1时为一步后向平滑;
平滑器的后向更新方程为:
其中yk为k时刻目标的可观测状态,Z1:k为1到k时刻的量测集合,pS,k+1/k为存活概率,Dk/k(yk|Z1:k)为k时刻存活目标和新生目标的PHD滤波结果,Fk+1/k(yk+1|yk)为k-1到k时刻的状态转移函数,Dk+1/k(yk+1|Z1:k)为k到k+1时刻存活目标和新生目标的PHD预测,Dk+1/L(yk+1|Z1:k)为L向k+1时刻存活目标和新生目标的后向递推结果;
上式可分解为:
Dk/L(yk|Z1:L)=Dk/k(yk 自适应目标新生强度的PHD平滑器的多目标跟踪方法专利购买费用说明
Q:办理专利转让的流程及所需资料
A:专利权人变更需要办理著录项目变更手续,有代理机构的,变更手续应当由代理机构办理。
1:专利变更应当使用专利局统一制作的“著录项目变更申报书”提出。
2:按规定缴纳著录项目变更手续费。
3:同时提交相关证明文件原件。
4:专利权转移的,变更后的专利权人委托新专利代理机构的,应当提交变更后的全体专利申请人签字或者盖章的委托书。
Q:专利著录项目变更费用如何缴交
A:(1)直接到国家知识产权局受理大厅收费窗口缴纳,(2)通过代办处缴纳,(3)通过邮局或者银行汇款,更多缴纳方式
Q:专利转让变更,多久能出结果
A:著录项目变更请求书递交后,一般1-2个月左右就会收到通知,国家知识产权局会下达《转让手续合格通知书》。
动态评分
0.0