改进粒子滤波算法的比较
第2期
张淼等:改进粒子滤波算法的比较
31
;:.。一。=八石:一。,o)(2)或卜。=FkP:.,F:+统一.(3)
砭=尸:“。圳TloIi)叫
(4)Z--=X“k卜。+砭(缸一^(叠¨,o))
(5)
p。t=哎_‘-。一墨珥E't_。
(6)
其中:Q¨,风为k时刻的过程噪声和量测噪声的协方
差阵;R,巩为非线性状态转移函数和量测函数的局
部线性化函数。
凡=警I…¨
(7)甄=訾I茗=磊卜。
(8)
抽样粒子
《.g(扎I乏!,,≈)=J7、r(以;爱¨,碟’)
3)对各粒子的权值进行计算。
4)重采样。
由于3)、4)同原始的粒子滤波算法,文中不再赘
述,且均采用重要性重采样算法。
1.2不敏粒子滤波算法(UPF)
Merwe等人聃1提出使用不敏的卡尔曼滤波方法(UKF)产生粒子滤波的重要性密度函数,称为Unscented粒子滤波器,由UKF产生的重要性密度函数与真实状态的概率密度函数的支集重叠部分更大,估计精度更高。其基本思想是每次采样的粒子由UKF算法进行更新,所得的均值和方差用于下次采样。其主要步骤为:
1)初始化。从先验分布中抽取J『v个粒子茗:一p(xo),i=1,2,…,Ⅳ。
2)在每一时刻用不敏卡尔曼滤波更新每一粒子,即:①计算每个粒子的西格玛点。
娥咒=睇!P孵望±汀再砑】
②时间更新。
以器。2几虻10藏£0地)
(9)
.『=0。…,2L
现一。=∑4“k儡
(10)
础一。=∑∥∞‰一础一。)x吲三。一班一。)1(11)
ⅧZ(O¨=叭t/肌z,¨(i)J次:!∞
(12)
理一:=∑4神础叫
(13)
③量测更新。
巴=∑4D(础叫一础一)×(露k一础q)’(14)
万方数据
匕。蒿4。饿:山一瑶:一-)×(罐0一%-(0H)’(15)
噩=尸:。巧1
(16)二:。=再-I(0l。.I+扁I(:。一z-Z‘(IO。一1)
(17)
P≯=P盟。一KkP;硭
(18)④从重要性密度函数窜(以J舅巴,缸)=J『、r(气;掣’,P?)中抽取粒子并计算归一化权重。
3)重采样。
1.3辅助粒子滤波算法《A_PF)
APF【91滤波以SIS为基础,并引入一个重要性密度函数g(互,iIZ..。),由该函数可以导出样本集{冠,i,}。其优点在于使用两次加权操作,使产生的粒子权值比通过SIR滤波产生的粒子权值变化更稳定,因而得到的估计结果更准确n01。其主要步骤为
1)通过成一p(互l墨一。)计算地i,其中i=1,2,…,Ⅳ;2)根据先验条件概率抽样墨-p(x。);
3)由越=器
(19)
计算权值并归一化;
4)重采样。1.4正则化粒子滤波算法(fuPF)
RPF【lq是由ChristianMusso和FrancoisLeGland提
出的,该算法使用密度估计理论计算后验分布的连续
密度,从连续分布
g(茗。瞬三,缸)=∑五p%(气一石∽(20)
中采样,从而缓解粒子退化现象。墨(茹)是核密度函数(KemelP.d.f)。且满足
墨(茗)2分(音)
(21)
其中,h>0为核带宽,后(.)为标准的核密度函数,且满足
JzK(茗)(Ix=0,㈧茗112K(x)dx<∞
(22)
当为等权值粒子时,最优核密度函数为Epanechnikov核
‰f寄(1_忪l|2)'忪忭1(23)
L0,
0戈|I≥1
其中:c为R“上单位球体的体积;rt为分布的维数。在最简单的情况下,若后验分布为具有单位协方差的高斯密度,则最优带宽为
h。=【8C-1(rI+4)2石】l/(””NV““’,
N为粒子数。
正则化粒子滤波算法需要在等权值的粒子下进行,因此对于粒子滤波,需要一个类似于系统采样的过程来首先产生等权值的粒子集。
基于改进粒子滤波算法的比较分析研究_专业资料。提出一类改进的粒子滤波算法.对于建议分布的选取方案,此算法采取强跟踪分散的卡尔曼滤波方式建立它的建议分布.由于线性...
改进粒子滤波算法的比较张 淼, 胡建旺, 周云锋, 童俊 (军械工程学院, 石 家庄 摘 050003) 要: 重要性密度函数的选择对粒子滤波至关重要, 围绕重要性密 度...
基于改进粒子滤波算法的比较分析研究_信息与通信_工程科技_专业资料。基于改进粒子滤波算法的比较分析研究2011 年 5 月第2 期 吉林师范大学学报( 自然科学版) ...
2 . Feb. 2009 改进粒子滤波算法的比较张 , 淼 胡建旺 , 周云锋 , 童俊 (军械工程学院 ,石家庄 050003 ) 摘 : 重要性密度函数的选择对粒子滤波至关重要 ...
关键词:粒子滤波 重采样 粒子 该付费资源由维普网提供 中国最大最早的...在粒子补偿的基础上,利用预测值与观测值的方差进行粒子重采样的改进粒子滤波算法...
改进的粒子滤波算法_专业资料。为了防止经多次重采样后粒子多样性的丧失,保持粒子的统计独立性,以应对强非线性系统或者意外突发情况,在重采样技术的基础上,提出了...
一种改进的粒子滤波算法及其性能分析_专业资料。针对非线性、非高斯系统状态的... 维普网 中国最大最早的专业内容网站 0 0 0.0 文档数 浏览总量 总评分...
26 卷 4 期第第 文章编号 : 1006 - 9348 ( 2009) 04 - 0120 - 05 计 算机仿真 2009 年 4 月 几种改进的粒子滤波算法性能比较相 ,汪立新 威 1 1,...
粒子。然后根据量测不断调整粒子的权重和位置,通 CSA Copyright ? 2011 Hanspub 梁磊 等 ? 粒子滤波算法的优化与改进 113 过调整后的粒子信息修正最初的经验条件...
一种改进的粒子群优化粒子滤波算法_专业资料。粒子群优化粒子滤波方法容易陷入局部最优,针对这一问题,提出一种改进的粒子群优化粒子滤波算法,该算法对惯性权重和...
热门文档