·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,Xian710129,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,则标准卡尔曼滤波算法为
? l4? l 《 测控技术> 01>1 年第 32 0卷第 3期 组合导航 自适应卡尔曼滤波改进算法研究 李旦, 永元 , 春波 秦梅702)119 ( 西北工业大学 自动化学院...
· 114· 《测控技术》 2011 年第 30 卷第 3 期 组合导航自适应卡尔曼滤波改进算法研究李 旦,秦永元,梅春波( 西北工业大学 自动化学院, 陕西 西安 710129...
· 114· 《测控技术》 2011 年第 30 卷第 3 期 组合导航自适应卡尔曼滤波改进算法研究李 旦,秦永元,梅春波( 西北工业大学 自动化学院, 陕西 西安 710129...
热门文档