文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 机械/仪表 > 组合导航自适应卡尔曼滤波改进算法研究_李旦
侵权投诉

组合导航自适应卡尔曼滤波改进算法研究_李旦

·114·《测控技术》2011年第30卷第3期

组合导航自适应卡尔曼滤波改进算法研究

李

旦,秦永元,梅春波

(西北工业大学自动化学院,陕西西安710129)

摘要:针对常规卡尔曼滤波由于噪声的统计特性与实际情况不相符而引起滤波误差增大的问题,提出了

一种新的在线估计系统噪声和量测噪声的自适应滤波算法。新算法通过新息序列自适应量测噪声,对Sage-Husa滤波算法进行改进以估计系统噪声,该算法在噪声统计特性未知的情况下能进行滤波计算。最后对改进的新算法与常规卡尔曼滤波算法作了对比试验分析,结果表明了改进算法的有效性。

Husa滤波;组合导航关键词:卡尔曼滤波;自适应滤波;新息序列;Sage-中图分类号:U666.1文献标识码:A文章编号:1000-8829(2011)03-0114-03

AnImprovedAdaptiveKalmanFilterAlgorithmforSINS/GPS

IntegratedNavigationSystem

LIDan,QINYong-yuan,MEIChun-bo

(SchoolofAutomation,NorthwesternPolytechnicalUniversity,Xian710129,China)

Abstract:AnewadaptiveKalmanfilteralgorithmispresentedaimingatfigureoutaccretionontheerrorofKalmanfilterwhenprocessnoisecovariancematrix(Q)andmeasurementnoisecovariancematrix(R)arein-correctlywithactualnoise.ThealgorithmestimatesRbasedoninnovationsequenceofmeasureandQthroughanimprovedSage-Husaadaptivefilter,whichcankeepthefilterworksteadilyandcorrectlywhenQandRare

unknown.PracticaltestonthenewapproachandtheconventionalKalmanfilteralgorithmcomparablyisgiven,theresultsdemonstratethatthenewalgorithmisvalidwhenappliedinSINS/GPSintegratednavigationsys-tem.

Keywords:Kalmanfiltering;adaptivefiltering;innovationsequence;sage-husafiltering;integratednavigation在组合导航中,卡尔曼滤波是进行信息融合的常用算法,使用标准卡尔曼滤波的前提条件是系统的动

但由于惯性器件本力学特性和噪声的统计特性已知,

身的误差及外部环境的动态特性使得这个前提条件往往不能满足,在这种情况下继续使用标准卡尔曼滤波算法不能保证滤波的稳定性。因此,许多文献提出自

[1-3]

,适应卡尔曼滤波算法来处理这类问题如带噪声

Husa自适应滤波和强跟踪卡尔曼滤波估计器的Sage-等,其基本思想是在滤波的同时,不断地对未知的或时

变的系统模型参数及噪声统计特性进行估计和校正,

Husa自适应以提高滤波的稳定性和精度。其中Sage-收稿日期:2010-05-19

作者简介:李旦(1985—),男,湖南娄底人,硕士,主要从事惯性导航与组合导航研究;秦永元(1946—),男,江苏常熟人,教授,博士研究生导师,主要从事惯性导航系统及容错组合导航系统的研究;梅春波(1985—)男,河南信阳人,博士研究生,主要研究方向为惯性导航与组合导航。

滤波由于增加了噪声的计算,使计算量增加,并且它不能同时自适应系统噪声和量测噪声,在使用过程中系

[4]

统噪声阵和量测噪声阵易出现负定性的情况,这势

5]提出了基于新息自适应必影响滤波的精度。文献[

估计量测噪声的方法,并用严密的数学推导证明了这

[5]

种方法的正确性,该方法不用增加系统维数,只需有限记忆长度内的新息即可,计算简单可靠。笔者在

Husa滤波算法相结合,此基础上与Sage-提出了一种

Husa自适应滤波算法,改进的基于新息的Sage-并以

SINS/GPS组合导航为例,对改进的算法进行了试验分析。

1基于新息的量测噪声自适应算法

设离散线性系统的状态方程和量测方程如下

Xk=Φk,k-1Xk-1+Wk-1Zk=HkXk+Vk

(1)(2)

[6]

式中,系统噪声Wk和量测噪声Vk互不相关,它们的协方差阵分别为Qk和Rk,则标准卡尔曼滤波算法为

第1页

你可能喜欢

  • 扩展卡尔曼滤波
  • 卡尔曼滤波方法
  • 卡尔曼滤波代码
  • GPS导航系统
  • 卡尔曼滤波matlab

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email