融合自适应卡尔曼和小波的MEMS陀螺去噪方法

合集下载
  1. 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
  2. 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
  3. 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。

㊀2021年㊀第2期
仪表技术与传感器
Instrument㊀Technique㊀and㊀Sensor
2021㊀No.2㊀
基金项目:湖北省宜昌市自然科学研究项目(A20-3-004);湖北省水电工程智能视觉监测重点实验室开放基金项目(2020SDSJ07);水电工程智能视觉监测湖北省重点实验室建设项目(2019ZYYD007)收稿日期:2019-12-26
融合自适应卡尔曼和小波的MEMS陀螺去噪方法
吴佳慧1,冉昌艳1,2
(1.三峡大学计算机与信息学院,湖北宜昌㊀443002;2.湖北省水电工程智能视觉监测重点实验室,湖北宜昌㊀443002)
㊀㊀摘要:为提高MEMS陀螺仪信号的测量精度,提出一种融合卡尔曼和小波的MEMS陀螺仪自适应抗野值去噪方法㊂卡尔曼滤波中根据信息对干扰数据进行实时检测,通过修正增益或状态的一步预测值抑制野值对滤波精度的影响,然后利用小波分析对滤波后的陀螺仪信号的低频㊁高频分量同时进行阈值处理㊂实验表明该方法去噪效果优于卡尔曼滤波和Visushrink,陀螺仪x㊁y㊁z轴零偏不稳定性在该方法下比卡尔曼滤波分别提高了31.0%㊁29.3%㊁30.5%,比Visushrink分别提高了2.4%㊁12.1%㊁12.4%㊂关键词:MEMS陀螺;抗野值;自适应卡尔曼滤波;信息;小波去噪;低频噪声
中图分类号:V241.5㊀㊀㊀文献标识码:A㊀㊀㊀㊀文章编号:1002-1841(2021)02-0109-04
MEMSGyroscopeDenoisingMethodBasedon
AdaptiveKalmanandWavelet
WUJia⁃hui1,RANChang⁃yan1,2
(1.SchoolofComputerandInformation,ChinaThreeGorgesUniversity,Yichang443002,China;
2.HubeiKeyLaboratoryofIntelligentVisionBasedMonitoringforHydroelectricEngineering,Yichang443002,China)
Abstract:ToimprovethemeasurementaccuracyofMEMSgyroscopesignal,anadaptiveoutliereliminatingmethodofMEMSgyroscopecombiningKalmanandwaveletwasproposed.IntheKalmanfilter,theinterferencedatawasdetectedinrealtimeac⁃cordingtotheinformation.Bymodifyingtheone⁃steppredictedvalueofgainorstate,theinfluenceofoutliersonfilteringaccuracywassuppressed,andthenwaveletanalysiswasusedtoprocessthelowandhighfrequencycomponentsofthefilteredgyroscopesignalsimultaneously.ExperimentsshowthatthedenoisingeffectofthismethodisbetterthanthatofKalmanfilterandVisush⁃rink.Thebiasinstabilityofgyroscopex,yandzaxisisimprovedby31.0%,29.3%and30.5%respectivelycomparedwithKalmanfilter,itisimprovedby2.4%,12.1%and12.4%respectivelycomparedwithVisushrink.
Keywords:MEMSgyroscope;outliereliminating;adaptiveKalmanfilter;information;waveletdenoising;lowfrequencynoise
0㊀引言
基于微机电系统(micro⁃electro⁃mechanicalsystem,MEMS)惯性传感器的MEMS惯性导航技术是惯性导航技术的一个重要分支,因其系统具有成本低㊁体积小㊁功耗低以及抗冲击强等优点而被广泛应用于无人机导航系统中[1]㊂MEMS传感器是MEMS惯性导航系统的核心,其精度直接或间接影响了无人机导航的精度㊂然而,惯性MEMS传感器由于漂移会产生较大的噪声㊁偏置和尺度因子误差[2],为提高无人机导航的鲁棒性,减少陀螺仪随机漂移误差,文献[3]和文献[4]都利用时间序列建模分析对陀螺仪进行卡尔曼滤
波处理,验证了卡尔曼滤波在降低陀螺仪随机误差中的有效性㊂但忽略了MEMS陀螺仪信号中野值等干扰数据的影响㊂文献[5]采用小波去噪的算法对陀螺随机漂移有一定的抑制作用,但传统的小波分析都只是对信号的高频分量进行去噪处理,而忽略了低频分量的少许噪声㊂
针对以上问题,本文结合卡尔曼滤波和小波的优点,采用了将自适应抗野值卡尔曼滤波和改进的小波相结合的方法对陀螺仪的随机漂移误差进行处理㊂抑制了信号中野值对滤波发散的影响,提高了滤波精度㊂同时也更好地抑制了陀螺仪低频信号中的噪声,有效地提高了去噪效果㊂1㊀MEMS陀螺随机漂移建模
时间序列分析作为一种数理统计分析方法,该方法根据平稳时间序列的变化规律建立差分方程,把一个高度相关的平稳时间序列表示成一个数字递推的
㊀㊀


㊀110㊀InstrumentTechniqueandSensor
Feb.2021㊀
形式㊂时间序列分析模型通常分为自回归滑动平均模型(ARMA)㊁滑动平均模型(MA)和自回归模型(AR)㊂统计特性表明,MEMS陀螺仪建模的阶数比较低,通常不超过3阶,且AR模型作为线性方程,在计算上比ARMA和MA模型更具优势[6-7],因此本文分别采用自回归模型AR(1)㊁AR(2)和AR(3)对MEMS陀螺仪随机漂移进行建模,采用最终预报误差FPE准则对模型参数进行估计[8]
,估计结果如表
1所示㊂
表1㊀AR模型参数估计结果
a1
a2a3
FPE
AR(1)0 02999 3730ˑ10
-7
AR(2)0 02870 03939 3902ˑ10-7AR(3)
0 02730 0383
0 0354
9 3635ˑ10-7
㊀㊀从表1可看出AR(3)的FPE最小,但是和AR
(1)的FPE相差不大,在保证模型准确的情况下,为计算方便,本文选用AR(1)模型作为陀螺仪随机漂移模型:
mk+1=0 0299mk+εk+1
(1)
式中:mk+1㊁mk分别为tk+1㊁tk时刻的陀螺仪误差;εk+1为均值为0㊁方差为σ的白噪声㊂2㊀自适应抗野值卡尔曼滤波
陀螺仪输出信号中往往都含有野值,而这些野值通常会影响卡尔曼滤波效果,所以在文中采用一种自适应抗野值卡尔曼滤波,该滤波在卡尔曼的基础上根据信息对滤波增益和预测值进行了修正,更好地提高了滤波精度[9]㊂
假设系统的状态方程为Xk+1=AXk+BWk(2)量测方程为
Zk+1=HXk+1+Vk
(3)
式中:Xk+1,Xk分别为tk+1,tk时刻的状态量;Zk+1为tk+1
时刻的量测量;Vk为系统量测噪声,其值为AR(1)模型的估计误差,方差为R;Wk为系统过程噪声,其方差为Q,其值为AR(1)模型中白噪声εk+1的方差σ㊂Wk和Vk的统计特性为
E(Vk)=E(Wk)=0
Cov(Vk,Vs)=Rδks,Cov(Wk,Ws)=QδksCov(Vk,Wk
)=0ìîíïï
ïï(4)
式中:∀k,s,δkk=1;δks=0㊂
卡尔曼滤波过程:^Xk+1|k=A^Xk|k
Pk+1|k=APk|kAT+BQBT
Kk+1=Pk+1|kHT[HPk+1|kHT
+R]^Xk+1|k+1=^Xk+1|k+Kk+1εk+1P
k+1|k+1=[In-Kk+1H]Pk+1|k
ìîíïïïïï
ïïï(5)
信息:
εk+1=Zk+1-H^Xk+1|k
(6)前k+1时刻信息序列ε(ε1,ε2, ,εk+1)的方差:
Sk+1
=1k+1ðk
l=0
[εl+1-E(ε)]2(7)
式中:^Xk|k,^Xk+1|k+1分别为tk,tk+1
时刻的系统状态向量的时间更新;^Xk+1|k为tk时刻系统状态向量的一步预测值;Pk+1|k为tk时刻的系统协方差矩阵的一步预测值;Pk|k,Pk+1|k+1分别为tk,tk+1时刻的系统协方差更新;Kk+1为tk+1时刻的的卡尔曼滤波增益;E(ε)为信息序列ε
的均值㊂本文中,A=0 0299,B=1,H=1㊂
以信息为中心,以信息序列的最大偏差为半径r1
画圆,以β倍的信息序列的最大偏差为半径r2画圆,如图1所示

图1㊀抗野值滤波原理图
令r1=Sk+1,r2=βSk+1,βɪ(0,1),其中Sk+1是前k+1时刻信息序列的方差㊂
当 εk+1|-|E(ε) >r1,则认为当前的观测数据
是野值等于干扰数据,系统的主要偏差来源于观测值,则应降低当前时刻的滤波增益,减少观测值对系统的状态估计占有的权重,重新计算k+1时刻的卡尔曼滤波增益,修正公式为
Kk+1=αKk+1,αɪ(0,1)(8)
当r2< εk+1|-|E(ε) ɤr1,则认为观测数据是
正常的,系统的主要偏差来源于预测值,则应修正预
测值,重新计算k+1时刻的预测值^X
k+1|k
,修正公式为^Xk+1|k=^Xx+1|k+γεk+1
,γɪ(0,1)(9)
当 εk+1|-|E(ε) ɤr2,则认为观测和预测数据
都正常,不做任何修正㊂
㊀㊀


㊀第2期吴佳慧等:融合自适应卡尔曼和小波的MEMS陀螺去噪方法
111㊀㊀自适应抗野值卡尔曼流程图如图2所示
㊂图2㊀自适应抗野值卡尔曼流程图
3㊀改进的小波去噪
传统的小波去噪就是把含噪信号进行小波变换,根据小波系数之间的关系或者相应的准则设定一个阈值,进而对变换后的小波系数的高频分量进行处理,保持低频分量不变,得到新的小波系数,最后对其小波逆变换,得到去噪信号㊂
在典型的MEMS陀螺系统中,采用Allan方差对MEMS陀螺仪进行噪声分析和性能评估,能够准确地测出MEMS陀螺仪常见的噪声系数:量化噪声㊁角度随机游走和零偏不稳定性等[10-11]㊂量化噪声是陀螺仪输出端的高频分量,而角度随机游走和零偏不稳定性都是长期的低频现象[12]㊂因此,本文中采用了一种先选择分解水平,并对该层的低频分量和每一层的高频分量同时进行阈值处理的方法,对MEMS陀螺仪信号进行了去噪处理㊂
小波分析中,信号的能量通常集中体现在小部分幅度比较大的小波系数上,而噪声的频率和能量谱相对分散,因此噪声的小波系数绝对值比较小,且能量分散在大部分的小波系数上[13],随着分解层数的增加,噪声信息在高频分量中所占比例逐渐减少,有用信号所占比例逐渐增加,当噪声含量非常小而无法区分时,此时对该层的低频分量也进行阈值去噪可以更好地抑制陀螺仪的低频噪声㊂
(1)对带噪信号进行小波分解,确定分解级别;为
了得到噪声阈值化的分解水平,首先需要计算每层高频分量的PSR,即
Sn=
max(Wn)
ðNn
i=

Wn,i
(10)
式中:maxWn为位于第n层的高频分量的绝对值的最大值;Wn,i为位于第n层第i个高频分量的绝对值;Nn为第n层高频分量的个数;Sn可以识别高频分量中的噪声,当Snɤρ,Sn+1>ρ,ρɪ(0,1)时,其中ρ为
区分某层高频分量是否含有噪声的一个阈值,高频分
量只包含信号系数㊂那么分解层数k=n[14]

(2)对每层的高频分量阈值化处理,并对选定分解级别的低频分量也阈值化处理;(3)对处理后的高频分量和低频分量进行小波重
构,得到去噪信号㊂4㊀实验仿真
将MEMS陀螺仪静置于实验转台进行实测,静置时间为1h,采样频率为200Hz㊂对实测数据进行融
合卡尔曼和小波的去噪方法进行实验,融合卡尔曼和小波去噪流程图如图3所示,并利用Allan方差对陀螺仪噪声系数进行评估,陀螺仪x㊁y㊁z轴的去噪效果对比图如图4㊁图5㊁图6所示,陀螺仪x㊁y㊁z轴的噪声系数对比分别如表2㊁表3㊁表4所示

图3㊀
融合卡尔曼和小波去噪流程图
图4㊀MEMS陀螺仪x
轴去噪效果分析
图5㊀MEMS陀螺仪y轴去噪效果分析
㊀㊀


㊀112㊀InstrumentTechniqueandSensor
Feb.2021㊀
图6㊀MEMS陀螺仪z轴去噪效果分析表2㊀陀螺仪x轴噪声系数对比分析表
量化噪声系数
/(ᵡ)
角度随机游走/[(ʎ)㊃h
-1

零偏不稳定性/[(ʎ)㊃h-1]原始数据0 2626530 4322373 936395卡尔曼滤波0 0658440 1885891 259665Visushrink小波去噪0 0239790 0026420 137148本方案去噪
0 006388
0 000884
0 040733
㊀㊀从表2㊁表3㊁表4可以看出,本方案去噪后所估计的量化噪声系数㊁角度随机游走和零偏不稳定性均小于卡尔曼滤波和Visushrink小波去噪㊂
表3㊀陀螺仪y轴噪声系数对比分析表
量化噪声系数
/(ᵡ)
角度随机游走/[(ʎ)㊃h
-1

零偏不稳定性/[(ʎ)㊃h-1]原始数据0.3166920.4627366.082270卡尔曼滤波0.0467880.1603241.982798Visushrink小波去噪0.0125250.0037010.936515本方案去噪
0.004333
0.000994
0.198316
表4㊀陀螺仪z轴噪声系数对比分析表
量化噪声系数
/(ᵡ)
角度随机游走/[(ʎ)/h
-1

零偏不稳定性/[(ʎ)/h-1]原始数据0.2633030.4192464.115378卡尔曼滤波0.0738240.1411941.359070Visushrink小波去噪0.0717160.0102950.614795本方案去噪
0.009008
0.001352
0.102585
㊀㊀陀螺仪x㊁y㊁z轴去噪后方差对比如表5所示㊂从表5可以看出,本方案去噪后方差均小于卡尔曼滤波和Visushrink小波去噪㊂
表5㊀陀螺仪x㊁y㊁z轴方差对比分析表(ʎ)2/s2
x轴方差
y轴方差z轴方差卡尔曼滤波1.4046ˑ10-41.7096ˑ10-41.3321ˑ10-4Visushrink小波去噪6.1799ˑ10-62.7634ˑ10-51.6009ˑ10-6本方案去噪
1.2395ˑ10-7
7.0925ˑ10-7
3.3453ˑ10-8
5㊀结论
针对MEMS陀螺输出信号噪声大㊁有野值等问题,本文采用一种融合卡尔曼和小波的自适应抗野值去噪方法对MEMS陀螺仪进行了降噪处理,通过Allan方差分析估计陀螺仪噪声系数,并与卡尔曼滤波方法和Visushrink小波去噪方法进行对比分析,结果表明本文方法的量化噪声系数㊁角度随机游走和零偏不稳定性均小于卡尔曼滤波和Visushrink小波去噪,尤其陀螺仪x㊁y㊁z轴零偏不稳定性在本方案下比卡尔曼滤波分别提高了31.0%㊁29.3%㊁30.5%,比Visushrink小波去噪分别提高了2.4%㊁12.1%㊁12.4%㊂
参考文献:
[1]㊀王思远,韩松来,任星宇,等.MEMS惯性导航技术及其应
用与展望[J].控制与信息技术,2018(6):21-26.
[2]㊀BENM,WEIWJ,TONGWJ,etal.MEMSgyrodenoising
basedonsecondgenerationwavelettransfo⁃rm[C]//2010FirstInternationalConferenceonPervasiveComputing,SignalProcessingandApplications.IEEE,2010:255-258.[3]㊀张伟.MEMS陀螺随机误差建模与Kalman滤波方法[J].
现代导航,2018,9(2):100-103.
[4]㊀孙伟,吴增林,耿诗涵,等.ARMA模型的MEMS陀螺随机误
差卡尔曼补偿方法[J].测绘科学,2017,42(12):52-56.
[5]㊀赵宣懿,孔雪博,熊智,等.基于低成本MEMS陀螺的小波
阈值去噪应用研究[J].传感器与微系统,2017,36(12):54-56.
[6]㊀李杨,胡柏青,覃方君,等.MEMS陀螺的抗野值自适应滤
波降噪方法[J].压电与声光,2015,37(4):590-594.
[7]㊀严恭敏,李四海,秦永元.惯性仪器测试与数据分析[M].
北京:国防工业出版社,2015:142-143.
[8]㊀吕春红,李洋,赵坤,等.基于AR模型的MEMS惯导随机
误差分析方法[J].航天控制,2018,36(6):31-35.
[9]㊀马姓.基于UKF的自适应野值剔除算法[J].计算机测量
与控制,2016,24(8):283-285.
[10]㊀杜少林,陈书钊,陈鹏光,等.基于Allan方差的MEMS陀
螺仪噪声分析[J].仪表技术与传感器,2018(5):20-22.
[11]㊀黎奇,白征东,赵思浩,等.Allan方差方法分析环形激光
陀螺仪噪声的性能评估[J/OL].清华大学学报(自然科学版):1-8[2019-05-31].https://doi.org/10.16511/j.cnki.qhdxxb.2019.22.009.
[12]㊀NASSARS,ACHWARZKP,SHEMIMYNE.Modelingin⁃
ertialsensorerrorsusingautoregressive(AR)models[J].Navigation,2004,51(24):259-268.
[13]㊀崔治,李加升.基于小波熵自适应最佳分解层数确定算
法[J].仪表技术与传感器,2015(6):127-130.
[14]㊀SRIVASTAVAM,ANDERSONCL,FREEDJH.Anew
waveletdenoisingmethodforselectingdecompositionlevelsandnoisethresholds[J].IEEEAccess,2016,4:3862-3877.
作者简介:吴佳慧(1997 ),硕士研究生,主要研究方向为无人
机视觉惯性导航㊂E⁃mail:1563925261@qq.com
通信作者:冉昌艳(1974 ),讲师,博士,主要研究方向为导航
系统算法以及传感器信号处理研究㊂E⁃mail:ranchy@ctgu.edu。

相关文档
最新文档