一种鲁棒的Kalman滤波方法
合集下载
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
( 西北核技术研究所 西安 7 1 0 0 2 4 )
摘
要
在 目标跟踪测量中 , 由于各种 噪声 的影 响, Ka l ma n滤波算法对野值数据的估计经 常出现较大误差 , 直 接影 响 了定位结 果。修
正增益 的滤波方法在野值相对较小的情况下误 差不 能有效 的识别 。为此 , 提 出残差权重 自适应抗野值 的 Ka l ma n滤波方法 , 该 方法能 明显
量测方程 :
环境 的影 响 , 测量数据受到各种随机噪声 的污染 , 使 得测量 数据的可靠性和可用性下 降 , 导致 观测数 据 中出现少 量野 值, 甚 至出现成 片野值 , 即错误 的测 量数据 , 这 些测量 值 明
显 偏 大 或 偏 小 。如 果 这 些 数 据 不 剔 除 , Ka l ma n滤 波 算 法 的
一 H X +
Cl a s s Nu mb e r TP2 7 4
l 引 言
Ka l ma n滤 波 算 法 l _ 】 ] 具有 递推性 , 无须存储大量历史信 息, 不 但 可 以对 平 稳 的 、 一维 的随机 过程 进行估 计 , 也 可 以 对非平稳 的、 多 维 随 机过 程进 行估 计 , 因而 广 泛 应 用 于 导 航
的 降低 野 值 对 定 位 结 果 的影 响 , 对 实 测 数 据 的 仿 真 果 表 明 了该 方 法 的有 效 性 , 满足试验要求 。
关键 词 目标跟踪 ;Ka l ma n滤 波;野值 ;鲁棒
中图分类号 TP 2 7 4
A Ro b u s t Ka l ma n Fi l t e r Me t h o d
Abs t r a c t S i n c e a f f e c t e d b y k i n ds o f n oi s e i n t a r g e t t r a c k i n g,t h e e v a l u a t i o n o f me a s ur e me n t o u t l i e r s u s i n g t he n o r ma l Ka l ma n f i l t e r a l g o r i t h m o f t e n d e v i a t e s e r i o u s l y a n d h e n c e t he p o s i t i o ni n g r e s u l t o f t a r ge t i s i n t e r f e r e d .Th e Ka l ma n f i l t e r a l g o r i t h m wi t h g a i n r e v i s e d d o e s n o t
e f f e c t i v e l y i d e n t i f y t h e o u t l i e r r e l a t i v e l y l e s s t h a n n o r ma 1 .Ba s e d o n t h e s i t u a t i o n me n t i o n e d ,a r o b us t Ka l ma n f i l t e r a l g o r i t h m i s p r o p o s e d i n t h i s p a p e r ,wh i c h c a n o b v i o us l y r e d u c e t h e i nf l u e nc e o f o u t l i e r e r r or . The s i mu l a t i o n o f p r a c t i c a l d a t a c o n f i r ms t ha t t h e v a l i di t y o f t h i s me t h od me e t s t h e r e q u i r e me n t o f e n g i ne e r i n g p r a c t i c e . Ke y Wo r d s t a r g e t t r a c ki n g,Ka l ma n f i l t e r ,o u t l i e r,r o b us t
总第 2 8 3期 2 0 1 3 年第 5 期
计 算 机 与 数 字 工 程
C o mp u t e r& Di g i t a l En g i n e e r i n g
Vo 1 . 41 No .5
71 6
一
种 鲁 棒 的 Ka l ma n滤 波 方 法
武 昱 曹 鑫 钱克 昌 李小杰 张 阳 阳
w u Yu CAO Xi n QI AN Ke c h a n g L I Xi a o j i e ZHANG Ya n g y a n g
( No r t h we s t I ns t i t u t e o f Nu c l e a r Te c hn o l o g y,Xi ’ a n 7 1 0 0 2 4 )
2 标 准 Ka l ma n算 法
估计 问 题 中 经 常 考 虑 如 下 随 机 线 性 离 散 系 统 模
型 ~ 。
状态方程 :
+ l — X + Wk ( 1 )
跟踪 、 信息融合 、 信号处理等领域 。
测 控 系统 在进 行 测 量 的 过 程 中 , 由于 系 统 自身 或 外 界
摘
要
在 目标跟踪测量中 , 由于各种 噪声 的影 响, Ka l ma n滤波算法对野值数据的估计经 常出现较大误差 , 直 接影 响 了定位结 果。修
正增益 的滤波方法在野值相对较小的情况下误 差不 能有效 的识别 。为此 , 提 出残差权重 自适应抗野值 的 Ka l ma n滤波方法 , 该 方法能 明显
量测方程 :
环境 的影 响 , 测量数据受到各种随机噪声 的污染 , 使 得测量 数据的可靠性和可用性下 降 , 导致 观测数 据 中出现少 量野 值, 甚 至出现成 片野值 , 即错误 的测 量数据 , 这 些测量 值 明
显 偏 大 或 偏 小 。如 果 这 些 数 据 不 剔 除 , Ka l ma n滤 波 算 法 的
一 H X +
Cl a s s Nu mb e r TP2 7 4
l 引 言
Ka l ma n滤 波 算 法 l _ 】 ] 具有 递推性 , 无须存储大量历史信 息, 不 但 可 以对 平 稳 的 、 一维 的随机 过程 进行估 计 , 也 可 以 对非平稳 的、 多 维 随 机过 程进 行估 计 , 因而 广 泛 应 用 于 导 航
的 降低 野 值 对 定 位 结 果 的影 响 , 对 实 测 数 据 的 仿 真 果 表 明 了该 方 法 的有 效 性 , 满足试验要求 。
关键 词 目标跟踪 ;Ka l ma n滤 波;野值 ;鲁棒
中图分类号 TP 2 7 4
A Ro b u s t Ka l ma n Fi l t e r Me t h o d
Abs t r a c t S i n c e a f f e c t e d b y k i n ds o f n oi s e i n t a r g e t t r a c k i n g,t h e e v a l u a t i o n o f me a s ur e me n t o u t l i e r s u s i n g t he n o r ma l Ka l ma n f i l t e r a l g o r i t h m o f t e n d e v i a t e s e r i o u s l y a n d h e n c e t he p o s i t i o ni n g r e s u l t o f t a r ge t i s i n t e r f e r e d .Th e Ka l ma n f i l t e r a l g o r i t h m wi t h g a i n r e v i s e d d o e s n o t
e f f e c t i v e l y i d e n t i f y t h e o u t l i e r r e l a t i v e l y l e s s t h a n n o r ma 1 .Ba s e d o n t h e s i t u a t i o n me n t i o n e d ,a r o b us t Ka l ma n f i l t e r a l g o r i t h m i s p r o p o s e d i n t h i s p a p e r ,wh i c h c a n o b v i o us l y r e d u c e t h e i nf l u e nc e o f o u t l i e r e r r or . The s i mu l a t i o n o f p r a c t i c a l d a t a c o n f i r ms t ha t t h e v a l i di t y o f t h i s me t h od me e t s t h e r e q u i r e me n t o f e n g i ne e r i n g p r a c t i c e . Ke y Wo r d s t a r g e t t r a c ki n g,Ka l ma n f i l t e r ,o u t l i e r,r o b us t
总第 2 8 3期 2 0 1 3 年第 5 期
计 算 机 与 数 字 工 程
C o mp u t e r& Di g i t a l En g i n e e r i n g
Vo 1 . 41 No .5
71 6
一
种 鲁 棒 的 Ka l ma n滤 波 方 法
武 昱 曹 鑫 钱克 昌 李小杰 张 阳 阳
w u Yu CAO Xi n QI AN Ke c h a n g L I Xi a o j i e ZHANG Ya n g y a n g
( No r t h we s t I ns t i t u t e o f Nu c l e a r Te c hn o l o g y,Xi ’ a n 7 1 0 0 2 4 )
2 标 准 Ka l ma n算 法
估计 问 题 中 经 常 考 虑 如 下 随 机 线 性 离 散 系 统 模
型 ~ 。
状态方程 :
+ l — X + Wk ( 1 )
跟踪 、 信息融合 、 信号处理等领域 。
测 控 系统 在进 行 测 量 的 过 程 中 , 由于 系 统 自身 或 外 界