第4 3卷增刊 ( I ) 2 0 1 3年 7月
东南大学学报 (自然科学版 ) J O U RN AL O F S O U T HE AS T UN I VE RS I T Y( Na mr a l S c i e n c e E d i i t o n )
Vo 1 . 4 3 S u p ( I ) J u l y 201 3
d o i: 1 0 . 3 9 6 9/ j . i s s n . 1 0 0 1— 0 5 0 5 . 2 0 1 3 . S 1 . 0 1 8
迭代容积卡尔曼粒子滤波算法 王华剑 景占荣郑文泉屈保平 (西北工业大学电子信息学院,西安 7 1 0 0 7 2 )
摘要:针对标准粒子滤波算法粒子退化和贫化问题,提出了一种基于高斯一牛顿迭代思想的容积卡尔曼粒子滤波算法.该算法利用当前量测信息,使用容积数值积分原则通过以一组确定的点集
和相应的权值直接计算非线性随机函数的均值和方差,避免了求导运算,并通过 G a u s s— N e w t o n 迭代方法对容积卡尔曼滤波 ( C KF )的非线性最小二乘问题进行求解,减小了线性化误差,以此来产生粒子滤波算法的重要性密度函数,使得迭代 C K F产生的重要性密度函数更接近于真实后
验概率分布,从而改进了滤波性能.仿真结果表明,与粒子滤波和 C P F滤波相比,迭代 C K F粒子 滤波具有更高的估计精度 .
关键词:非线性系统;粒子滤波;高斯一牛顿迭代;容积卡尔曼滤波;重要性密度函数中图分类号: T P 2 7 3 文献标志码:A 文章编号: 1 0 0 1— 0 5 0 5 ( 2 0 1 3 )增刊( I ) 4 3 0 8 5 - 0 4
I t e r a t e d c u b a t u r e Ka l ma n p a r t i c l e il f t e r a l g o r i t hm
Wa n g H u a j i a n J i n g Z h a n r o n g Z h e n g We n q u a n Q u B a o p i n g ( S c h o o l o f E l e c t r o n i c s a n d I n f o r ma t i o n E n g i n e e r i n g, No r t h we s t e r n P o l y t e c h n i c a l Un i v e r s i t y, Xi’ a n 7 1 0 0 7 2,C h i n a )
Ab s t r ac t:I n
o r d e r t o i mp r o v e p a r t i c l e i mp o v e is r h me n t a n d s a mp l e s i z e d e g e ne r a c y o f t h e s t a n da r d
p a r t i c l e i f l t e r( P F )a l g o i r t h m,a n o v e l i t e r a t e d c u b a t u r e Ka l ma n p a r t i c l e i f l t e r b a s e d o n t h e G a u s s - Ne wt o n i t e r a t i o n me hod t i s p r o p os e d.Th e n e w a l g o r i h m t di r e c t l y us e s t h e c u b a t u r e r u l e . b a s e d a n— me r i c a l i n t e g r a t i o n me h od t t o c a l c u l a t e he t me a n a n d c o v a r i nc a e o f he t no n l i n e a r r a n d o m f u n c t i o n b y a s e t o f he t c e r t a i n p a r t i c l e s a n d he t i r we i g ht s .M e n wh a i l e, t he Ga u s s— Ne wt o n i t e r a t i o n me ho t d i s
u s e d t o s o l v e t h e l e a s t s q u re a p r o b l e m o f t h e c u b a t u r e Ka l ma n i f l t e r( c r y), t h e r e b y r e d u c i n g l i n e r- a i z a t i o n e r r o r a n d g e n e r a in t g t h e i mpo ta r nc e d e ns i t y f u n c i t o n o f he t a l g o r i h m.The t i mpo r t nc a e d e n s i t y f u n c io t n o f t h e n e w lg a o r i h m t ha t t i n c o r p o r a t e s he t l a t e s t o b s e r v a i t o ns i s mo r e c l os e t o he t s ys
t e m
s t a t e p o s t e i r o r p r o b a b i h t y d e n s i y. S t o he t f i l t e r p e r f o r ma nc e i s i mp r o v e d .S i mu l a t i o n r e s u l t s s h o w ha t t c o mp a r e d wi t h he t P F nd a he t CP F.t h e i t e r a t e d Cu b a t u r e Ka l ma n p a r t i c l e il f t e r me t h o d h a s a h i g h e r e s i t ma t i o n a c c u r a c y. Ke y wor d s:n o n l i n e a r s ys t e m;p a r t i c l e il f t e r;Ga us s— Ne wt o n i t e r a io t n;c u ba t u r e Ka l ma n il f t e r;i m— p o r t a n c e d e n s i t y f u n c io t n
近年来,在自动控制、目标跟踪、人工智能、故
的参数估计和状态滤波问题 .粒子滤波的基本思想是采用随机 Mo n t e C rl a o对先验分布在状态空间产生一组随机样本集,构建重要性密度函数,递推地用这些随机样本集和其权重来近似于状态变量真实的后验概率密度函数,用样本均值来代替积分运
障检测、数字通信和金融统计等复杂系统中广泛存在着非线性/非高斯的状态估计问题.基于序贯 Mo n t e C a r l o的粒子滤波 ( p a r i t c l e i f l t e r,P F)利用
数值逼近的方式较好地解决了非线性/非高斯系统
收稿日期: 2 0 1 3 - 0 5 - 0 6 . 作者简介:王华剑( 1 9 8 O一),男,博士生,讲师, w h j— w i n n e r@1 6 3 . c o m;景占荣 (联系人 ),男,教授,博士生导师 j i n g z r@n w p u . e d u . c n .
基金项目:航天支撑技术基金资助项目( N 7 C H 0 0 0 4 )、武警基础基金资助项目( WJ Y 2 0 1 1 1 4 ) . 引文格式:王华剑,景占荣,郑文泉,等.迭代容积卡尔曼粒子滤波算法[ J] .东南大学学报:自然科学版, 2 0 1 3, 4 3( s
1 ): 8 5—8 8 .[ d o i: 1 0 3 9 6 9/ j . i s s n . 1 0 0 1~0 5 0 5 . 2 0 1 3 . S 1 . 0 1 8]

E.mammujin91977@163.com 万方数据 第7期 穆静等:迭代容积卡尔曼滤波算法及其应用 随机产生大量粒子近似计算后验概率密度。随着迭代次数 的增加,PF实现时会出现...
IMM迭代扩展卡尔曼粒子滤波跟踪算法_专业资料。该文提出了一种交互式多模型(IMM)迭代扩展卡尔曼粒子滤波机动目标跟踪算法。该算法在多模型中使用了改进的粒子滤波器...
com 第7 期 穆静等: 迭代容积卡尔曼滤波算法及其应用 1455 生大量粒子近似计算后验概率密度。随着迭代次数的增加, PF 实现时会出现粒子退化和贫化现象 [ 9 10...
基于迭代卡尔曼粒子滤波的目标跟踪算法研究_机械/仪表_工程科技_专业资料。第2... 迭代容积卡尔曼粒子滤波... 0人阅读 4页 3.00 远距离干扰环境下目标跟...
平方根容积卡尔曼滤波算法及其应用_信息与通信_工程...解决 EKF、迭代EKF等,但是以增加计算量为代价的【...粒子滤波方法(particlefilter,PF)依据蒙特卡洛仿 真的...
M N 所以用 L M 产生的重要概率密度函 数更接 近于 = N 真实后验概率分布 最后的仿真结果表明迭代扩展卡尔曼粒子滤波的估计性能要优于现有的粒子滤波算法 - ...
迭代扩展卡尔曼粒子滤波器_专业资料。提出了一种基于迭代扩展卡尔曼的粒子滤波新方法.该方法利用迭代扩展卡尔曼滤波的最大后验概率估计产生粒子滤波的重要性密度函数...
联邦式扩展卡尔曼粒子滤波算法_专业资料。为了使联邦滤波器能有效处理非高斯、... 基于迭代卡尔曼粒子滤波... 4人阅读 8页 3.00 迭代容积卡尔曼粒子滤波...
IMM迭代扩展卡尔曼粒子滤波... 暂无评价 5页 2.00元 基于扩展卡尔曼粒子...曼粒子滤波引入联邦滤 波结构中, 得到一种新的联邦式扩展卡尔曼粒子滤波算法。...
求积分卡尔曼粒子滤波算法_电子/电路_工程科技_专业资料。求积分卡尔曼粒子滤波... 迭代容积卡尔曼粒子滤波... 暂无评价 4页 3.00 基于卡尔曼粒子滤波的目...
热门文档