基于改进概率假设密度的多目标跟踪算法-王海环.pdf
《基于改进概率假设密度的多目标跟踪算法-王海环.pdf》由会员分享,可在线阅读,更多相关《基于改进概率假设密度的多目标跟踪算法-王海环.pdf(8页珍藏版)》请在淘文阁 - 分享文档赚钱的网站上搜索。
1、第31卷 第1期2016年2月电波科学学报CHINESE JOURNAL oF RADl0 SCIENCEV0131,No1Februarv,2016王海环,王俊基于改进概率假设密度的多目标跟踪算法J电波科学学报,2016,31(1):5360DOI:1013443j cjo rs-2015031801wANG H H,wANG JMultitarget tracking based on improved proba bility hypothesis density filterJchinese journal of radio science,201 6,31(1):53 60(in c
2、hinese)DOI:1013443jcjors2015031801基于改进概率假设密度的多目标跟踪算法王海环 王俊(西安电子科技大学雷达信号处理国家重点实验室,西安710071)摘 要 经典序贯蒙特卡罗概率假设密度(Sequential Mote Carlo Probability Hypothesis Density,SMCPHD)滤波中,将目标状态转移密度函数做为建议密度函数,没有利用当前观测信息,导致大部分预测粒子状态偏离目标真实状态,粒子退化严重针对上述问题,提出利用均方根容积卡尔曼滤波产生建议密度函数,对其进行采样得到预测粒子状态,该方法有严格理论基础,能有效减轻sMC PHD滤波
3、中的粒子退化,且适用性很强仿真实验对比了该算法、经典SMCPHD和基于无迹卡尔曼的SMCPHD算法的跟踪性能,验证了该方法无论对势估计还是对目标状态估计的精度都优于其他两种算法关键词 多目标跟踪;概率假设密度滤波;序贯蒙特卡罗;建议密度函数;均方根容积卡尔曼滤波中图分类号 TN953 文献标志码 A 文章编号 1005一0388(2016)010053一08DoI 1013443icjors2015031801Multitarget tracking based on improVed probability hypothesis density filterWANG Haihuan WANG
4、 Jun(N口fio以口Z Ln6 D,Rnd口r Sig九nZ ProfFssi理g,Xidin以U门iuPHi砂,Xi以起710071,Ci行n)Abstract Due to the most recent observational data being unused, the particles in sequential IoteCarlo probability hypothesis density(SMCPHD)filter which are drawn from prior transition is far awayfrom the real states and may
5、 seriously degenerate Aiming at these problems,we propose a method namedsquarerOOted cubature Kalman sequential Mote Carlo PHD(SCKSMCPHD)filter which uses squarerooted cubature Kalman“lter to generate the proposal density function and obtains the present particlesstates by sampling from the proposal
6、 density function The proposed method which can a11eviate particlesdegradation effectively has rigorous mathematical theoretical basis and strong adaptability Simulationcompares the proposed method with CSMCPHD filter and the SMCPHD based on unscented Kalman filterThe results show that the proposed
7、SCKSMCPHD f订ter has a higher accuracy in estimation of bothindividual state and target number than the two methods mentioned aboveKeywords multitarget tracking; probability hypothesis density; sequential Mote Carlo; proposaldensity function;sq uarerooted cubature Kalman filter弓 口由于需要进行数据关联,传统的多目标跟踪算
8、法运算量大、实时性差为解决上述问题,Mahler基收稿日期:2015一0318资助项目:国家自然科学基金(No61401526)联系人:王海环Email:haihuanwang126com于随机有限集11(Random Finite Sets,RFS)理论,对多目标跟踪进行集合建模,从而将单目标贝叶斯滤波推广到多目标领域,避免了数据关联但多目标贝叶斯滤波的最优解需要进行集合积分,一般情况万方数据54 电 波科 学 学报 第31卷下很难得到多目标全局后验概率密度,因而Mahler提出利用多目标全局后验概率密度的一阶矩代替其本身在多目标贝叶斯递推式中进行传递,这就是概率假设密度(Probabili
9、ty Hypothesis Density,PHD)滤波2PHD滤波通过一阶矩近似,降低了多目标贝叶斯滤波的计算复杂度,其序贯蒙特卡罗(Sequential Mote Carlo,SMC)实现形式3可在非线性非高斯条件下使用,但由于其基于序贯重要性采样原理,因而SMCPHD滤波具有和粒子滤波(Particle Filter,PF)同样的缺点,即建议密度函数的选择对算法性能的影响至关重要经典SMCPHD(C1assic SMCPHD,CSMCPHD)滤波中将目标状态转移方程作为建议密度函数,没有利用当前观测量,导致在运动模型不准时,大量粒子在迭代过程中权值趋于零,粒子退化严重针对SMCPHD滤波
10、中建议密度函数的选择问题,许多学者提出改进的SMCPHD算法,例如基于辅助粒子滤波的SMCPHD算法4、基于扩展卡尔曼滤波的SMCPHD(Extent Kalman SMCPHD,EKSMCPHD)算法5、基于无迹卡尔曼滤波的SMCPHD(Unscented Kalman SMCPHD,UKsMCPHD)算法r6等在这些改进的算法中,UKSMCPHD算法的跟踪性能最优7。8,但由于UKSMCPHD算法中采用无迹卡尔曼滤波(UnscentedKalman Filter,UKF)产生建议密度函数,而UKF的性能受目标状态维数的限制,因而UKSMCPHD在目标状态维数较高时算法性能下降很快基于均方根
11、容积卡尔曼滤波的SMCPHD(SCKSMCPHD)算法,利用均方根容积卡尔曼滤波(Squarerooted Cubature Kalman Filter,SCKF)产生建议密度函数,然后对其进行采样得到预测粒子状态容积卡尔曼滤波(Cubature Kalman Filter,CKF)和UKF同属于利用数值积分解决高维积分问题的范畴,但同UKF不同,CKF中采用的容积点是基于球面一径向容积准则,经严密数学推导得出,有坚实的理论基础,且CKF性能不受目标状态维数的限制,适用性更强而SCKF是对CKF的进一步改进,避免了无论在CKF还是在UKF中都需进行的协方差矩阵的开方运算,进一步放宽了CKF的适
12、用范围仿真对比试验表明,SCKSMCPHD算法无论对目标数目还是对目标状态的估计精度都优于CSMCPHD算法和UKSMCPHD算法1 基于RFS的多目标跟踪11 PHD滤波RFs是指由数量有限的随机元所组成的集合,PHD滤波是基于RFS理论,将多目标跟踪中的目标状态集合和观测量集合分别看成两个RFS,再利用集合积分、集合导数及泛函理论,在多目标后验概率密度满足泊松分布的前提下,用全局后验概率密度的一阶矩来代替其本身在多目标贝叶斯滤波公式中传递,从而简化了多目标贝叶斯滤波设忌时刻有N(忌)个目标状态分别为颤川,x洲的目标,有M(忌)个状态分别为z,z。M(。)的观测量,基于RFS理论凹,分别对多
13、目标的目标状态集x。和观测集z。建模如下:x一(,1,靠,N(女)蚰(Z), (1)z一z,z女,M()炎(g) (2)式中犍(z)、炎(g)分别为目标状态空间Z E R”,和观测空问善R”z上所有有限子集的集合通过以上目标状态和观测量的RFS建模,可将单目标贝叶斯滤波推广到多目标跟踪中,得到多目标贝叶斯递推式;预测:p一1(x女l z1:H)rI pm一1(xl x女1)p女一1lJ(墨一l Z1;_1)H; (3)更新:p叭(xl z1:女)一i墨!墨!茎!叟!二!茎!l墨!二! (4)k(磊I墨)加H(置l z一。)蹯tJ式中:鲰(l)为多目标联合似然函数;加。(鼍z)为多目标联合后验概
14、率密度;加H(x。Iz。沪,)为多目标联合先验概率密度;加H(x。l墨一,)为多目标状态转移概率密度函数将多目标贝叶斯中的鼬H(x。l z,啦,)和p女(噩f z。:。)分别用其一阶矩D小一。(工)和D。(r)近似表示,得到PHD的迭代递推式n,预测:rD小1(x)一扎+l(依忙,(工l考)+户。,*(考)I,(工j考)D,(善)d考;(5)万方数据第1期 王海环等:基于改进概率假设密度的多目标跟踪算法 55更新:D女(工)一(1一户d,(工)D女1(x)+z夕d,(x)g(z x)D一1(x)c;A。+f户。;(x)g。(z x)Dj一l(工)dx(6)式中:户。,;(工)为目标存活概率;H
15、(I)为其单目标的状态转移密度;陬忙,(l)为衍生目标的概率密度函数;虮为忌时刻新生目标的密度函数;户叭为忌时刻目标检测概率;“为杂波概率密度;A。为杂波平均数;g;(l)为单目标似然函数12 SMCPHD滤波为将PHD滤波由理论引入到工程实现,B一NVo提出了SMCPHD滤波该算法通过一系列带权值的随机样本(加权粒子)来近似表示D(x),可在非线性非高斯条件下得出PHD滤波的闭合解假定x芒。,出)b,为矗一1(是1)时刻PHD的粒子集,L卜,是走一1时刻的粒子数,不考虑衍生目标,SMCPHD的算法实现步骤如下3:预测:分别对存活粒子建议密度函数纵(lx芒。,五)和新生粒子建议密度函数乡。(l
16、五)采样得到是时刻的粒子状态为x,zt,i一1,2,L川; 8【纨(I磊),iLH+1,LH+,。(7)由式(8)计算粒子x对应的权值叫:江,:l,f叫芒。户,。厂。卜。(xl。l x掣。)q。(l z罂,z。),J 净兄,L卜,;y。(xl。)(,。夕*(工:”J五),【 i=LH+1,LH+,女(8)式中:,t10,为新生粒子数,lD为每个新生目标的采样点数,R,=In(x)出为新生目标的期望数更新:根据式(9),利用观测集五更新粒子权值为叫l。一11:一,l 1一夕d。(工l。)+姜而,怠A眈+(H,儿:Ji一1,2,L女一1+,式中:,:(xl。)一户d,女(xl。)g(z j工l”)
17、,L一l+J(H,似:)一虬(x (9)一Ll十J E重采样:计算点时刻的目标数:N。一l :o百叫f,是对“”进行取整每一个目标固定采样个粒子,对粒子集x,丝。-州*进行重采样,并对权值做归一化处理得到是时刻的粒子集x,N。L。)拄。,其中L。一zN。目标状态提取:采用kmeans方法对重采样后得到的粒子集xp,N。L。墨,进行聚类分析,得到是时刻的目标状态估计SMCPHD滤波的关键步骤是最优建议密度函数的选择CSMCPHD中将目标状态转移函数做为建议密度函数,没有利用当前观测信息,在运动模型不准确时,会使大量粒子偏离目标真实状态,在SMCPHD递推式中,这些粒子的权值会变的很小,即这些粒子
18、对后验概率的贡献几乎为零,而真正有贡献的粒子在迭代过程中会越来越少,粒子退化严重在针对上述问题所提出的改进算法中,UKSMCPHD的性能卓越,但uKSMcPHD滤波中参数的选择受目标状态维数的影响,当目标状态维数较高时,算法性能不稳定,同时,UKsMcPHD算法中需要对协方差矩阵进行开方运算,一旦在迭代过程中出现协方差矩阵非正定,算法就会出错而SCKSMCPHD滤波算法,利用SCKF构建建议密度函数,既提高了算法的跟踪精度,同时避免了协方差矩阵开方运算,且算法性能不受目标状态维数限制,增强了算法的适用性和稳定性2 SCKSMCPHD滤波21 ScKF算法考虑一般的多目标跟踪问题,在直角坐标系下
19、给出目标离散时间的过程方程和观测方程,表示为虬一厂球,+雌, (10)【z女一矗(坼)+n式中:厂()和()分别为目标的过程模型和观测模型;鲰和z。分别为志时刻的目标状态和观测量;“卜、比分别为过程噪声和观测噪声,服从均值为0,协方差分别为QH、R的高斯分布当过程方程或观测方程为非线性时,贝叶斯滤波的最优解通常无法得到,利用近似得到贝叶斯滤波的次最优解是常用的方法同UKF相似,SCKF也是通过数值积分来近似得到高维积分,但同uKF通过UT变换选取Sigma点的方式不同,SCKF基于三阶球面一径向容积准则选取容积点万方数据56 电 波科 学 学报 第31卷y(厂)一j(班xp(一xlx)出一J。
20、厂(z)N(州7,J)dz (11)y(厂)一jiL。厂(删)r”l exp(一,2)d盯(y)drJs(r),”1 exp(一r2)d,一。,s(t); (15)J O =jU。厂(叫加)_蚤V(训, (16)y(厂)一J。,(小xp(一工7x)出:6,厂(ny,) (17)y(厂)叫:厂(9:) (18)叫z一麦,鼽为矩阵妒的第i列,9一州;1,川比UKF中sigma点的个数要少,且其对应权值的计算比UKF简单,因此SCKF的计算复杂度要低于UKF同时,SCKF的性能不依赖于参数的选择,且引入了QR分解,避免了矩阵开方运算,因而比UKF的稳定性要好22 SCKSMCPHD滤波鉴于SCKF在
21、处理非线性滤波中的优越性,利用SCKF构建SMCPHD中的建议密度函数,再对其进行采样得到预测粒子状态本文采用伪代码的形式详细介绍利用SCKF构建建议密度函数的步骤已知足一1时刻粒子集x芒。,叫芒,s2。)量,其中S出为第i个粒子的协方差矩阵的均方根,则利用SCKF得到建议密度函数,进而获取忌时刻存活粒子状态x(i一1,2,LH)的步骤如下:获取每个粒子所对应的容积点,其伪代码为for i一1,L女1for歹一l,2力zj:一1一_s芒l仍+x芒1,议。一12咒,endend利用状态方程进行时间更新,其伪代码为for i一1,L一lfor J一1,2九Z:忑一-一厂(菇*,),end讯。一哟以
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 改进 概率 假设 密度 多目标 跟踪 算法 王海环
限制150内