第19卷第5期 传感技术学报 CHINESE JOURNAL OF SENSORS AND ACTUATORS Vo1.19 No.5 2006年10月 0ct.2006 Research on the Application of the Time-Serial Analysis Based Kalman Filter in MEMS Gyroscope Random Drift Compensation LI Jie ,ZHANG W 一dong,LIUJun ,National Key l aboratory for Electronic Measurement Technology, 、 Department oJ Electronic Science and Technology,North University 0厂C ina,Taiyuan 030051,china/ Abstract:The compensating method for MEMS gyroscope random drift error is discussed.First its drift er— ror model is created by using the time-serial analysis,then the process of decreasing this drift error by making use of Kalman filter based on the above error model is expounded.The compensating results for the practica1 testing data of a MEMS gyroscope show,the drift error can be controlled effectively by the filtering method presented,and its application precision in practica1 system can be further proved. Key words:MEMS gyroscope;random drift error;time-series analysis;kalman filter EEACC:7630 基于时间序列分析的Kalman滤波方法 在MEMS陀螺仪随机漂移误差补偿中的应用研究 李 杰 ,张文栋,刘 俊 (中北大学电子科学与技术系电子测试技术国防重点实验室,太原030051) 摘 要:从工程实用的角度出发,探讨了MEMS陀螺仪随机漂移误差的有效补偿方法.首先采用时间序列分析的方法建立 了MEMS陀螺仪的随机漂移误差模型,然后阐述了用基于时间序列模型的Kalman滤波方法减小该漂移误差的具体方法.对 某MEMS陀螺仪实测数据的误差补偿结果表明,所介绍的滤波方法能够有效地抑制其漂移误差,提高MEMS陀螺仪在实际 系统中使用精度. 关键词:MEMS陀螺仪;随机漂移误差;时间序列分析;卡尔曼滤波 中图分类号:V241.5 文献标识码:A 文章编号:loo4-l699(2OO6)O5—22l5 5 MEMS陀螺仪是随着MEMS技术的发展所出 由于MEMS技术本身属于一门新兴的前沿交叉学 科,其中许多技术尚有待进一步地解决和发展,致使 目前所能加工和生产出的MEMS陀螺仪,其精度尚 处于中低水平,由其所组成的各类惯性测量系统也 现的一类新型惯性器件[1].由于其具有体积小、成本 低、重量轻、可靠性高等一系列优点,因此从它一开 始诞生就受到国内外相关领域和部门的高度重视, 很多国家都投入了大量的人力、物力、财力对其进行 研究,特别是近年来,随着其在各类制导武器系统中 应用的不断深入,其地位已经上升至一种战略高度, 这使得MEMS陀螺仪如同其它MEMS惯性器件一 样,得到了空前的发展,也取得了巨大的成果.然而, 主要应用于一些精度要求不高的场合,这极大地制 约了MEMS陀螺仪的实际应用领域和应用深度.如 何有效地提高MEMS陀螺仪的实际应用精度,不仅 是当前各国学者所关注和研究的一个热点问题,同 时也是MEMS陀螺仪在实际工程应用中所急需解 收稿日期:2006—07—01 基金项目:“十一五”装备预研项目资助(40404050101) 作者简介:李刘杰(1976一),男,讲师,博士(通讯联系人),现从事微惯性与微系统集成等相关技术研究,Lijie@nuc.edu.cn; 俊(1968一),男,教授,博士生导师,现从事微惯性、动态测试及智能仪器技术研究。 张文栋(1962一),男,教授,博士生导师,现从事MEMS、存储测试等相关技术研究。 维普资讯 http://www.cqvip.com
2216 传感技术学报 2006血 决的一项技术难题. 目前,提高MEMS陀螺仪精度的技术途径 主要有两种:一种是通过优化结构设计、提高加 工工艺水平等措施,在其设计和生产阶段完成, 其优点是可以提高器件本身的精度,但这种单 处理、模型形式的选取、模型参数的估计、模型适用 性检验等问题[1。 ,其中模型参数的选择是关键,其 次是模型的实用性检验. 1.1数据的采集、预处理与检验 采集信号,得到原始观测数据,按照时间序 列的建模要求,对该数据进行统计检验和预处 理,以得到平稳、正态、零均值的时间序列,这是 时间序列建模的基础工作.因此,在对MEMS 纯依靠硬件提高精度的方法,不仅所需的研制 经费高、研制周期长,而且从技术角度讲,其精 度的提高也十分有限;另一种是通过软件补偿 的方法在其应用阶段完成,即在MEMS陀螺仪 本身精度既定的情况下,通过建立其准确的误 差模型,并利用合适的补偿算法,提高其在实际 应用过程中的使用精度,与途径一相比,途径二 的最大优点则是成本低、周期短,而且精度提高 的余地也非常大.考虑到MEMS陀螺仪的静态 和动态误差,其补偿方法相对随机漂移误差较 为容易,本文重点探讨MEMS陀螺仪随机漂移 误差的有效补偿方法. 早在60年代末,国外就有学者对陀螺仪随 机漂移误差的补偿技术进行了研究_2],进入70 年代,国内也开始这方面的理论探讨和实践尝 试,并取得了可喜的成绩.纵观国内外的相关研 究,可以发现对陀螺仪随机漂移的误差补偿的过 程,其基本思路是:首先建立其误差模型,然后采 用一定的滤波技术对其进行估计与补偿.其中, 建模方法主要包括时间序列分析、神经网络及小 波分析等[2 ,滤波方法则主要包括Kalman滤 波、鲁棒滤波、非线性滤波及其这些滤波技术的 增强和改进等_1 .毋容置疑,现有这些滤波技术 比较有效地解决了常规陀螺仪的随机漂移误差 补偿问题,尤其是在漂移误差模型的建立方面, 成果更是丰硕.然而,有关MEMS陀螺仪随机漂 移误差补偿技术的研究,目前还相对较少,可供 参考的研究资料和学术论文也相对较少. 鉴于此,本文从工程实用的角度出发,详细 探讨基于时间序列分析的Kalman滤波技术在 MEMS陀螺仪随机漂移误差补偿中的应用方 法,旨在为如何提高MEMS陀螺仪的实际使用 精度提供一种思路和技术参考,作者更希望本 文能起到抛砖引玉作用,激起更多的研究人员 对其进行深入研究和探讨. 1 MEMS陀螺仪随机漂移误差的时 间序列分析与建模 时间序列分析建模的内容包括,数据的采集、数 据的统计分析(平稳性分析及相关函数分析)与预 陀螺仪的随机漂移信号建立时序模型时,首先 应保证该信号为零均值、平稳、正态时序. MEMS陀螺仪漂移的原始信号中包含常值分量 和随机分量,可以通过求均值来提取常值分 量,去掉均值(即常值分量)的随机漂移信号应 为零均值的.对于一般的测量系统,其正态性也 能保证,但因受未知的外部环境及内部因素的 干扰,信号的平稳性却难保证,所以在建模之 初,需对信号的平稳性进行判断.首先从观测数 据的自相关函数的变化特点来识别序列的平稳 特性,如果序列是非平稳的,则必须进行平稳 处理,一般将数据进行一阶或二阶差分处理 后,即能达到平稳性要求. (1)数据采集 MEMS陀螺仪实际输出的漂 移信号是连续的,而采用时间序列分析方法建模的 对象必须是离散的时间序列,为此,建模之初需要先 以一定的采样率对该连续信号进行采样,得到其离 散时间序列.图1为一段时间内所采集到的某 MEMS陀螺仪的原始漂移观测信号. 图1 某MEMS陀螺仪原始漂移信号 (2)数据预处理在MEMS陀螺仪随机漂移 信号建立时间序列模型之前,首先应保证该信号为 零均值、平稳、正态时间序列.MEMS陀螺的原始信 号中包含常值分量和随机分量,可以通过求均值来 提取常值分量,去掉均值(即常值分量)后的信号,通 常即为MEMS陀螺仪的随机漂移信号,有时该信号 因各种环境及MEMS陀螺仪本身因素的干扰,还可 能存在一定的趋势项,这可以通过对其作一阶或二 阶差分处理,使其满足零均值和平稳性的要求.图2 为与图1相对应的MEMS陀螺仪漂移信号,图3为 去掉线性趋势项之后的MEMS陀螺仪的随机漂移 信号. 维普资讯 http://www.cqvip.com
第5期李杰,张文栋等:基于时间序列分析的Kalrmn滤波方法在M 陀期 随枳漂移误差辛}偿中的应用研究2217 图2 MEMS陀螺漂移信号 图3 去掉趋势项的MEMS陀螺随机漂移信号 (3)数据检验 在建模之初,还应通过统计 检验的方法,对经过预处理后的MEMS陀螺仪 随机漂移信号的平稳性、正态性进行量化判断, 以确定预处理后的数据确实符合时间序列的建 模要求. ①随机数据平稳性检验 A、将样本记录分为』\,个等间隔区间,可以认 为每个区间上的数据是的; B、对每个区间计算其均方值(或分别计算均值 和方差),将这些子样值列成如下的时间序列: , , ,……, ; c、检验这一均方值序列,判断其是否有预料的 采样变化以外引起的变化和趋势. 有很多方法可以检验子样值的非平稳趋势, 本文采用的是一种非参数检验,即轮次检验方 法,具体检验过程此处不再赘述,感兴趣的读者 可以参考文献[13]. ②随机数据正态性检验方法 检验平稳随机数据是否服从正态分布,最直接 的方法是测量数据的概率密度函数,然后通过与理 想的正态分布函数作比较,判断其是否正态.本文采 用一种方便实用的非参数检验方法,即卡埃平方拟 合优度检验,具体检验过程此处不作详述,感兴趣的 读者可以参考文献[-13]. 1.2模型建立与参数识别 经数据检验可知,预处理后所得的MEMS陀螺 仪随机漂移数据,为平稳、正态、零均值的随机时间 序列,可以采用时间序列分析方法对其建模,即构造 个数学模型,以逼近真实MEMS陀螺仪随机漂移 数据的数学特性. 考虑到目前尚无MEMS陀螺仪随机漂移误差 的准确数学模型,本文采用试探方法建模,即首先采 用时间序列分析方法,对MEMS陀螺仪随机漂移误 差分别建立不同阶次的AR模型和ARMA模型, 然后依据模型残差越小误差模型准确性越高的原 则[13-16],从中选取适合本文所研究MEMS陀螺仪 的随机漂移误差模型. 1.2.1模型建立与参数识别 (1)模型建立 设MEMS陀螺仪的随机漂移误差模型为自回 归模型——滑动平均ARMA(p,q),其定义形式为: 土(女)一 ·- ̄C(k-1)+ ·土(脚)+…+ ·土( ) 一 1·a(t,--1)一 2·口(々_2)…·一 q·口( 1)+ 口女∈』\,JD(0,R:) (1) 式(1)中,P为AR模型阶数,q为MA模型阶 数,z(志)为时间序列信号,口(志)是白噪声序列, 为自回归系数, … 为自回归滑动参数, 』\,表示在k时刻固定时{ )是正态分布的随机变 量,m表示k时刻变动时{口 )之间相互.当q: 0时,式(1)退化为P阶AR模型,即: 土(女)一 · ̄<t-D+ ·i(脚)+…+ ·丑㈣+ (2) 当P一0时,(1)式退化为q阶MA模型.即: 丑 )一口(女)一以·a(t,-1)一 ·口( )一…一 ·口( (3) 对于不同的系统产生的随机序列可采用不同的 模型来描述,这3种模型之间存在着差别.ARMA、 AR、MA模型之间的差别是在它们的自相关函数和 偏相关函数上会反映出不同的特性.AR模型具有 自相关函数“拖尾”和偏相关函数“截尾”的性质; MA模型具有自相关函数“截尾”和偏相关函数“拖 尾”的性质;ARMA具有自相关函数和偏相关函数 都“拖尾”的性质.由于陀螺漂移模型的阶次都比较 低,一般不超过2阶至3阶,因此可以在模型参数数 目等于3的范围内,取A IC最小值所对应的模型. 由于ARMA模型相当于一个线性系统,对于最小 实现的线性系统,传递函数一般是有理分式,也就是 说,对于实际系统,随机ARMA模型的自回归阶数 大于或等于滑动平均阶数,所以实际应用中,误差模 型通常在AR(1)、AR(2)、AR(3)、ARMA(1,1) 和ARMA(2,1)中进行选择. (2)参数识别 将式(1)中定义的ARMA(p,q)模型写成如下 的矩阵形式: y—XtP+Agr (4) 式(4)中: 女Z卜1……Z卜 抖l …… 卜 l X== 1 Z,r2…… Z,r女 维普资讯 http://www.cqvip.com
22l8 传感技术学报 2006生 y一( H, ,…, ) , 一( , ,…, ) ak口 1……口 1 口抖1 口 ……Z卜升2 A=: : ‘. : 口 1口 2……口 ( , ,…, )T.定义误差模型的残差为: A一(y—X )·1 (5) 本文采用最小二乘法估计上式中的自回归系数 和自回归滑动系数 ,得到二者的估计值 和 ,具体过程此处不作详述. 1.2.2模型选取 利用上述建模与参数识别方法,以经过数据预 处理的MEMS陀螺仪随机漂移信号,作为模型的时 间序列输人信号,分别确定出AR(1)、AR(2)和AR (3)模型的自回归系数,以及ARMA(1,1)和AR— MA(2,1)模型的自回归滑动系数. 将所得到的系数分别代人相应的误差模型 中,以经过数据预处理的MEMS陀螺仪随机漂 移数据作为输人数据,分别得到用5种模型估计 出的时间序列,并计算各模型对应的残差.根据 模型残差值越小模型准确度越高的原则(即模型 对信号的拟合效果越好),从所建立的5种误差 模型中选取残差最小的模型,作为该MEMS陀 螺仪随机漂移误差的最终模型.表l是原始信息 的时间序列和各误差模型输出的时间序列,各自 所对应的均值和方差. 表1各模型残差对比 从表1中可以看出,ARMA(2,1)模型的残差 值最小,因此,本文将其作为MEMS陀螺仪的随机 漂移误差模型,其数学表达式如下: 五 )一1.034奴H)一O.035奴㈣+口( )一O.995a 1) (6) 式(6)中,z( )为ARMA(2,1)模型的输出,即 模型估计的时间序列,口(忌)是白噪声序列. 2基于时间序列分析的卡尔曼滤波方法在 M 陀螺仪随机漂移误差补偿中的应用 模型基础为: 土( )= 土( 1)+伫土( 2)+口( )+01a( ̄1) 写出与其相应的卡尔曼滤波方程的状态空 间模型[ ]: 状态方程:X(忌)一AX(忌一1)+BV( (7) 输出方程:Y( )一CX +W( ) (8) 其中, c wc 的统计特性为: E(W( ))一0;E(V( )一0 E(W( )vv5 )一Q E(V( ) )一RK ;E(W( )一0. 从系统的观点出发,可以认为陀螺漂移是以白 噪声为输人的系统输出. 设系统状态向量为;X㈤一[主㈨,童(卜 )] ; 过程噪声为Vc 一[口 0] ,则式(7)中的系数 A、B为: A一[ l -l 34一 。0 35]l ,B一11.0 0一 9 ]l 设w 为模型的估计误差,则有: z( )一童( )+W( ), 设系统的输出为:Y 一zc 则输出方程为:Y(D—CX( )+W( 其中:C一[1 0] w 的统计特性为符合卡尔曼滤波的统 计特性.对上述系统方程,可写出如下的卡尔曼滤波 递推表达式[12]: X , 1一AX 11 X —Xk, 1+K [yK—C X , 1] H + ~ (9) P 卜l—AP 卜lA +上 卜lB P —EI—K C]P 。 1 CX 式(9)中,X , 为滤波器状态的一步预测估 计,X 为k时刻滤波器的状态,K 为k时刻滤波器 的增益矩阵,R为系统量测噪声方差,其值为模型估 计误差的方差,Q为系统的过程噪声方差,其值取为 『二r Lu“ 01 ( .JI, P 为滤波误差的协方差阵, , 为一 1 n1 步预测误差的协方差阵,P的初值为单位_=:ILu 上.J , 为k时刻滤波器的输出.将实际测量得到的 MEMS陀螺仪漂移数据作为该卡尔曼滤波器的输 人,对其进行滤波处理,滤波处理结果如图4所示, 其中,蓝色细线表示滤波前的原始信号,红色细线表 示在ARMA(2,1)模型基础上,用Kalman滤波方 法对其进行滤波处理的结果,表2中给出了滤波前 后各自的数据统计特性对比. 维普资讯 http://www.cqvip.com
第5期李杰,张文拣等:基于时间序列分析的Kalnlm滤波方法在MHVS陀螺钗随柳.漂移误差补偿中的应用研究2219 2 536 漂移误差补偿的具体实施过程. 参考文献: 2 534 2 532 [1]刘俊,石云波,李杰.微惯性技术[M].北京:电子工业出版社, 2005. 图4 Kalman滤波结果 [2]Duslman On Gyro Drift Models and Their Evaluation[J]. 表2原始数据与滤波后数据比较 原始数据 均 值 协方差方 差 IR E Transactions on Aerospace and Navigation Electronic, 1962,5(2):230—234. Kalman滤波 2.5331 1.0129 ̄009 3.1826 ̄005 2.5331 4.2525 ̄007 6.521 I ̄004 [3]田自耘.陀螺仪漂移测试基础[M].北京:国防工业出版社, 1998. [4]胡恒章.陀螺仪漂移测试原理及其实验技术[M].北京:国防工 业出版社,1984. 从图4中可以直观地看出,滤波后数据的波动性 明显变小,这表明经过滤波处理,数据的噪声变小了. 同时,从表2也可以看出,滤波前后数据的均值并没有 发生变化,这主要是因为Kalman滤波属于线性无偏最 优滤波;而滤波后数据的方差比滤波前小了一个数量 级,这说明滤波后的数据分散程度显著地减小了. 实际应用中,我们可以先用上述滤波方法对 MEMS陀螺仪的输出信号进行滤波处理,然后用滤波 处理后的输出数据进行各种惯性测量运算,以便得到 [5]潘鸿飞,杨柏军,王立强.陀螺仪随机漂移的测量及其数学模型 的建立[J].上海航天,2003,3,20—23. [6]臧荣春,崔平远.陀螺随机漂移时间序列建模方法研究[J].系 统仿真学报,2005,18(4),1845—1847. [7] 田蔚风.神经网络在陀螺漂移误差模型辨识中的应用[J].中国 惯性技术学报,1998,6(3).35—38. [8]徐丽娜,邓正隆.小波分析用于陀螺仪漂移测试信号分析的研 究[J].中国惯性技术学报,2003,11(1),49—53. [9]刘鲁源,陈玉柱,陈刚,李士心.基于小波变换的陀螺漂移建模 与实验研究中国惯性技术学报[J].2004,12(1):61—65. [1O]万彦辉,秦永元.小波分析在陀螺信号滤波中的研究[J].压电 与声光,2005,27(4),455-457. 更高的测量精度. 3结束语 利用时间序列分析的建模方法和Kalman滤波 技术,可以有效地减小MEMS陀螺仪的随机漂移误 [11]吉训生,王寿荣.小波变换在MEMS陀螺仪去噪声中的应用 [J].海军工程大学学报,2006,19(1):150—152. [12]付梦印,邓志红,张继伟.Kalman滤波理论及其在导航系统中 的应用[M].北京:科学出版社,2003. [13]邓自立.最优滤波理论及其应用:现代时问序列分析方法 [M].哈尔滨:哈尔滨工业大学出版社,2000. [14](美)J.S贝达特, G.皮尔索著.(凌福根译).随机数据分 析方法[M].1976. [15]杨叔子,吴雅.时间序列分析的工程应用(上、下册)[M].武 汉:华中理工大学出版社,1996. 差,对提高MEMS陀螺仪的实际应用精度十分有 益.本文的主要贡献有以下三点: (1)给出了用时间序列分析方法建立MEMS 陀螺仪随机漂移误差的基本思想和具体方法; (2)给出了Kalman滤波在MEMS陀螺仪随 机漂移误差估计与补偿中的具体应用方法; (3)从工程实用的角度阐述了MEMS陀螺仪 [16] Box GEP,Jenkins GM.Time Series Analysis Forecasting and ontCrol[M].Honlden-Day.San Francisco,1970. (上接第2214页) 版社,2000.4-5 [4]有限元方法基本教程[M].第三版.伍义生译.北京:电子工业 出版社,2003.181 [2]Geiger W,Butt W,U,Gaisser A,et a1.Decoupled Microgyros and the Design pPrinciple DAVED[C]//The 14th IEEE Inter— national Conference,2001,170—173 [5]姚雅红,吕苗,赵永军.采用薄片溶解工艺制造微机械惯性仪 表的实验研究[J].清华大学学报,1998,12—15 [6]宋华清,石兢,林成鲁.SOG技术及其新进展[J].功能材料, 2003.34(3):262—265 [3]许本文,焦群英.机械振动与模态分析基础[M].北京:机械工 业出版社,1998.67—77
因篇幅问题不能全部显示,请点此查看更多更全内容
Copyright © 2019- 91gzw.com 版权所有 湘ICP备2023023988号-2
违法及侵权请联系:TEL:199 18 7713 E-MAIL:2724546146@qq.com
本站由北京市万商天勤律师事务所王兴未律师提供法律服务