第32卷第12期2011年12月
仪器仪表学报
VoL32No.12Dec.20ll
ChineseJournalofScientificInstrument
MEMS传感器随机误差Allan方差分析水
高宗余,方建军,于丽杰
(北京联合大学自动化学院北京100101)
摘要:MEMS传感器中随机误差较大,有时会覆盖传感器中有用信号,提出采用Allan方差(Allanvariance)方法对MEMS传感器实测数据进行分析,系统地分析了引起MEMS传感器误差的随机噪声种类及其来源和特性,确定其各项系数,根据系数获得其功率谱密度,根据功率谱密度分析法与Allan方差分析法获得对应各项随机误差的数学模型,然后以数学表达式的形式得到统一的数学模型,再与卡尔曼滤波相结合得到增强的卡尔曼滤波,最后通过车载实验对MEMS—INS/GPS各个姿态进行卡尔曼滤波与改进后卡尔曼滤波2种滤波方法的比较,实验结果表明新滤波方法能很好地提高微惯性系统各个姿态精度。关键词:MEMS;Allan方差;随机噪声;功率谱密度;数学模型中图分类号:TN253
文献标识码:A
国家标准学科分类代码:460.402
Allanvarianceanalysisforthestochastic
error
of
MEMS
sensors
GaoZongyu,FangJianjun,YuLijie
(The
College
ofAutomation,BeiiingUnionUniversity,Belling100101,China)
Abstract:Insomecases,largestochasticapproachas
a
errors
usuallyoverrideeffectivesignalsinMEMS¥ensol瞎.Allanvariance
timedomainhasbeenproposed
to
commonwayinanalyzingfrequencystabilityin
sources
analyzethedata
measurement
measuredwithMEMSsen¥or8anddescribethe
errors
andcharacteristicsofrandomnoisesthat
error
are
cause
ofMEMSsensors.Thecoefficientsofindividualstochastic
determinedusingAllanvarianceapproach
are
to
obtaintheirpowerspectraldensities.Meanwhile,themathematicalmodelsofallstochasticelTOrs
derivedin
combinationwithpowerspectraldensityanalysis.Aunifiedcalibrationmathematicalmodelisobtainedintheformofdifferentialequationformultiplestochasticelrors.AnenhancedKalmanfilterisdesignedeffectthroughincorporatingtheunfedcalibrationmodelintotraditionalMEMS-INSaland
error
to
obtainbetterfiltering
equation.Finally,tradition—
eIlIIanced
Kalmanfilters
are
applied
to
measuretheposesofMEMS—INS/GPSinvehicleexperimentsandresult
to
showsthat
enhanced
Kalmanfilterissuperior
traditional
one
inimprovingtheprecisionofmicroinertialnavigation.
Keywords:MEMS;Allanvariance;stochasticnoise;powerspectraldensity;mathematicalmodel
随机误差特性分析拉1。惯性导航(INS)系统能够高速地
1
引言
输出加速度及角速度,然而其精度会随着时间而退化,主要是由于不同的误差源,这些误差随着在惯导航算法中数据积分的积累,将会引起航向误差。因此对传感器误差的建模及估计变得异常重要。本文主要采用功率谱密度¨1(PSD)及Allan方差对MEMS.INS随机过程进行分析。首先对所采集的数据采用Allan方差法获得其特性曲线。此后通过对曲线分析以获得存在于数据集中的随
Allan方差…技术最初是为了研究精密仪器的频率稳定性而在19世纪60年代发展产生的,其有助于识别存在于测量仪器中的误差种类及大小。由于惯性传感器与这类仪器的类似性,这一方法已经应用于各类设备的
收稿日期:2010-02
ReceivedDate:20104)2
・基金项目:国家自然科学基金(50805004)、模式识别与智能机器人系统学术创新团队项目(PHR201107149)资助项目
万方数据
仪器仪表学报
第32卷
机误差的种类及大小,最后对随机误差进行识别、建模、计算出其系数及各类误差。在得到各个误差及系数后,采用单元白噪声对误差的微分方程进行描述,对于其中无理谱模型一刮进行微分近似,获得相应的各项误差数学模型,最后对其模型进行统一化,进而与卡尔曼滤波相结合得到增强卡尔曼滤波器;采用文中所述方法可得到精确的滤波效果,通过实验其精度得到提高,与GPS结合采用本文方法也可得到较准确的轨迹。
2
Allan方差概述
2.1功率谱密度(PSD)
PSD的主要特点在于描述时间序列的频谱特性,是一种分析数据及表示数据特性的方法,同时对随机误差模型的建立有重要作用。通过对一系列样本的自相关函数估值进行傅里叶变换可计算其相应的PSD。
2.2
Allan方差
在Allan方差数据分析中,假设数据的不确定性是由误差特性给出。每个误差源协方差的大小是由数据估值得来。AU肌方差详细的原理描述及怎样应用于时频分析领域可参考文献[7.8]。
Allan方差法只能确定每个独立误差源的特性,但是所有误差源需组成一个统一的校正模型以便于卡尔曼滤波对其进行校正。下面首先对传感器随机误差的微分方程进行推导。然后推导出多个随机误差的统一校正模型。3.1传感器随机误差的微分方程
Allan方差法和其后确定的惯性传感器随机误差的PSD参看文献[3],这里首先利用PSD来确定随机误差相应的微分方程。给出随机过程的PSD,滤波器的传递函数能够通过式(1)得到:
S。(∞)=IG(j∞)I
2
(1)
式中:S;(ccJ)为随机过程菇的PSD,G(jto)为滤波器的传
递函数,tO其值为2矶根据线性系统理论,下面关系式
成立:
Y(jw)=G(曲)X(j∞)
(2)
式中:Y(jw)是系统输出的傅里叶变换,x(j吐,)是系统输入的傅里叶变换。式(2)两端执行傅里叶逆变换,就可获得线性系统的微分方程。这里首先考虑最化噪声及角/速度随机游走。根据方程(1)和量化噪声的PSD,则量化噪声整形滤波器的传递函数为:
G。(jOJ)=j∞Q√r
(3)
由此量化噪声的微分方程为:
万方数据
d。(t)=Q√%(t)
(4)
式中:H(t)为单元白噪声,Q为鼍化噪声系数。角速率随机游走及速度随机游走分别是角速度及加速度的白噪声。根据卡尔曼滤波理论,它们可以直接与INS姿态误差方程及速度误差方程相结合。对于其余3类噪声,分别对2种情况进行处理:有理谱形式及无理谱形式。对于角速率/)Jn速度随机游走,PSD是有理谱,通过圆周率代替频率可重写为:
一
S。(∞)=竺2
∞
(5)
根据方程(1),相应的整形滤波器的传递函数为:
五,
G,(jcc,)=导
(6)
J叫
因此角速度随机游走及加速度随机游走的微分方程
可表示如下:
d。=Ku。(t)
(7)
式中:“.(t)为单元白噪声,K为其噪声系数。对与闪烁噪声和斜坡噪声,PSD是无理谱,因此选择一阶高斯马尔科夫过程来近似实际的闪烁噪声过程,用二阶高斯马尔科夫一1来近似实际的斜坡噪声过程。对于闪烁噪声,采用一阶马尔科夫过程近似为:
d向(£)+卢d历(t)=flBu:(t)
(8)
式中:口是互相关时间,需要确定;口是闪烁噪声系数;Ⅱ:(t)是单元白噪声。对于斜坡噪声,采用二阶高斯马尔科夫过程来近似:
d。(t)+√r2∞od。(t)+∞02d。(t)=Ru3(t)
(9)
式中:尺是梯度噪声系数,∞。是需要确定的二阶系统的固有频率,n,(£)是单元白噪声,由此,推出了角速率/)JD速度随机游走、闪烁噪声和梯度噪声微分方程如式(7)、
(8)和(9)所示。
3.2统一的校正模型
量化噪声、角速率/加速度随机游走、闪烁噪声及斜坡噪声是否可以同时存在于一个传感器中取决于实际数据的Allan方差分析。这些随机噪声的微分方程通过方程(7)、(8)、(9)表示,为方便起见我们采用微分算子来表示:
“¨半
讪)=黜
(10)
d,(t)=矿币Ru而3(t)
式中:D是微分算子。定义新的函数:(t)如下:
z(t)=d。(t)+如(f)+d,(£)
(11)参考文献[10—11]进行整理可得到3项噪声融合的
等价随机误差模型为:
3建立统一校正模型
第12期
高宗余等:MEMS传感器随机误差Allan方差分析
:‘4’(f)+口Iz‘3’(f)+屹∥(t)+口3z‘1’(t)+a4z‘o’(t)=
bot03(t)+6I∞2(t)+62∞1(f)+63∞o(t)(12)
4
GPS/MEMS・INS组合的扩展卡尔曼滤波
本节主要推导出结合随机误差模型的GPS/MEMS.
INS误差方程,可通过前面部分所述的惯性传感器方程
,。=[三至手三妻],G,=[萎],日。=[享]7
b32b3b2
b3bI
b3bob2b3
b22626Ib2bo
Q,.(r)=
(17)
6Ib3
6Ib2612
blbo
bob3
bob2
bobI
b02
为了便于与式(13)相结合,对式(15)进行离散化:zl(蠡+1)=也。,.(知,k+1)工l(知)+G1鸭.(知)
(18)zl(k)=日。工l(后)
(19)
式中:咖。.(后,k+1)=e7‘缸=I+,。△t,缸是离散化后的样本间隔,离散过程的噪声协方差矩阵为:
Q。.(后)*Q,.(r)At
(20)
毛(k),i=2,…,6的状态空间可根据以上对z。(后)的
万方数据
处理方式获得。扩展MEMS-INS误差方程式为:
[浆》∥七乎“’删qbn,(k¨,k+1。,)】×嘲r<k).1+【:搦(21)
式中:咖w(蠡,I|}+1)是初始系统的状态转移矩阵,与方程
(12)所述一致;如(七,k+1)为:
“(后,k+1):『03×24。风。M1
1,如(五,||}+1)是斜对角矩
阵:
,xx(后,k+1)=diag(屯."…,屯^)(22)
噪声协方差矩阵为:
鲫,=电2】
∞,
式中:Q,是噪声协方差矩阵,用于说明初始系统的量化
噪声、角/速度随机游走噪声。Q。是斜对角矩阵:
级=diag(Q,.…Q.)(24)
5实验仿真
本文中实验为MEMS.INS/GPS组合,其主要器件为MEMS三轴惯性器件及GPS系统。这部分首先对传感器随机误差系数进行计算,其次采用文中所述方法对MEMS.INS/GPS姿态误差进行实验仿真,最后对组合惯性导航运
行轨迹进行实验仿真。首先以量化噪声为例根据Allan方差法计算其误差系数,利用图1参考文献[1,14-15]获得在矿(r)一r的重对数图上的量化噪声系数。这里图2及图3分别为MEMS传感器及加速度计6h的数据测试的Allan方差图,其相应的各个系数如表1及表2所示。
图1
z轴陀螺量化噪声系数结果
Fig.1ZaxisgymAllanvarianceresultwithslopeof-1
仪器仪表学报
第32卷
图2
MEMS陀螺Allan方差结果Fig.2
MEMSgyroAU叽varianceresults
图3
MEMS加速度Allan方差结果
Fig.3MEMSaccelerometerAⅡ蚰variKilceresults
表1陀螺辨识误差系数
陀螺量化噪声(。)堡铲专考器芋
Table1Gyroidentification
error
coefficients
x轴口,=II.385
Q,=16.476
Q;=13.225
y轴
B,=0.02054
B,=0.02001
B。=0.01204
兰垫生三!丝:!
墨z三竺:兰生:型:!
表2加速度计的辨识误差系数
Table2Accelerometer
identification
error
coefficients
加速度毪警氅学黛竽耘
y轴
1.888×10一
I.805×10~
1.735×10+3
兰塾
竺三!丝垒三竺笠三!:
万方数据
表3陀螺5次测试量化噪声
Table3Gyroquantizationnoiseforfivetests(o)
接下来采用文中上述方法对实际惯性传感器系统建h。根据相应的噪如(t)+例m(t)=flBu2(t)
(25)d,(t)=Ku。(t)
(26)
%‘2’(t)+敝‘1’(t)=
/酽+卢mB∞。‘1’(‘)+脚。‘0’(t)
(27)
根据式(15)及式(27),陀螺菇轴的统一校正模型的
工F(t)=F酽X伊(t)+GFn,弘(t)
(28)z,(t)=如&(£)
(29)
系数矩阵为:
Fp=【:?8】
(30)
G,-[邵缸2+矿日2]7
(31)日。=[0
1]
(32)
根据式(30),噪声协方差矩阵为:
蹦加[邸磊印磊卵∽,
对式(28)、式(29)进行离散化:
“后+1)=(二。。三At)“后)+G。%(后)
(34)
立校正模型。对惯性系统采集数据10声系数获得噪声的微分方程。最后获得多个随机噪声的
统一校正模型并且推导出惯性传感器系统的扩展卡尔曼滤波。这里,首先推出随机噪声的微分方程。根据以上分析,在测试中对陀螺需考虑3种随机噪声,分别是:角随机游走、闪烁噪声及角速率随机游走;对加速度计需考虑4种随机噪声,分别是:量化噪声、速率随机游走、闪烁噪声及加速度随机游走。这里只对陀螺菇轴进行详细分析。根据式(7)、式(8),陀螺髫轴的闪烁噪声和角速率随机游走微分化为:
式中:B和K分别为闪烁噪声和角速率随机游走的统一校正模型,是式(11)的低阶表示,其系数可通过把R=0及tO。=0代入参考文献[12・13,16-18]中的相关公式得到。因此陀螺茗轴的统一校正模型为:
状态空间为:
第12期
高宗余等:MEMS传感器随机误差Allan方差分析
2867
Z萨(后)=[01]工。(后)
(35)
州牝[邵,/品r2
离散化后噪声协方差矩阵为:
邸 ̄/酽+矿曰2Atl
o邸
+∥2
BAt(r+矿曰2)At
1
(36)
陀螺其他轴及各向加速度离散化校正模型都可通过上述过程获得。对所有离散化校正模型加以组合,即可获得式(21)所示的扩展卡尔曼滤波模型,可用于MEMS.INS/GPS组合中。这里采用新模型对MEMS—INS/GPS进行姿态分析,采用上述数据模型对2种情况进行对比数据采用实测数据,误差系数采用MEMS器件标准系数及文中所述方法计算所得系数进行滤波比较,分别比较了km/h的速度绕着方形000
m,各个姿态误差如图4—9所示。
图4北向位置误差
Fig.4Errorsofnorthposition
图5东向位置误差
Fig.5Errorsofeastposition
图6北向速度误
Fig.6Errorsofnorthvelocity
万方数据
0
,0
7
0E
0
≤
吣
-o-0
tfs
图7东向速度误差
Fig.7Errorsofeastvelocity
图8北向姿态误差(横滚)
Fig.8Errorsofnorth
attitude(roll)
图9东向姿态误差(俯仰)
Fig.9Errorsofeast
attitude(pitch)
测量结果表明采用文中所述的方法及模型对系统性论
文中主要在几个方面讨论了Allan方差在MEMS惯参考文献
ALLANDW.Statisticsofatomicfrequencystandards
[C].Proceedings
oftheIEEEInternationalSymposium,
NewYork,USA,1966(54)’:221-230.
6种状态,在试验中车载体以20操场运行1
能有很大改善,更接近实际的状况。
6结
性传感器校正模型建立中的应用:首先,辨识传感器误差源及确定相应的噪声参数;其次,推导出单个随机误差的微分方程;然后,对混有多个随机误差的系统求出了统一的校正模型;最后,对2种方法进行比较说明。增强卡尔曼滤波能够对MEMS.INS/GPS组合中的各个姿态误差进行优化,实验结果表明j由于采用了真实的随机误差,卡尔曼滤波的结果更加精确,其组合运行轨迹也能更好的
接近真实轨迹。
[1]
2868
仪器仪表学报
KOR.Standardspecificationformatguideandtestproce—durefor
particlefilter
urement
第32卷
algorithm[J].Journal
ofElectronicMeas-
[2]
sin#e.axisinterferometricfiberopticgyros[M].
[16]
AV[D].
andInstrument。2009.23(6):24-28
USA:IEEEStd.,1972:952—1977.
吴永芝,余容红.李兴红,等光电信号参数的动态提取方法[J].电子测量与仪器学报,2009,23(5):
69-73
[3]HOUH.Modelinginertial"n¥oPJ
errors
using
Canada:Univ.Calgary。2004:182・188.
[4]WANGJH。GAOY.AnintelligentMEMSIMU—basedland
vehiclenavigationsystemenhancedbydynamicsknowledge
WUYzH,YURH.LIXH,eta1.DyllⅢllicextracting
methodofphotoelectrici811aIleetronicMeasurementand
pammet∞[J].Journal
ofE-
[C].Proc.US
[5]
ION61stAnnMeeting,2005:27-29.Instrument,2009,23(5):69-73
CRASSIDISJL.LAIKL.HARMANRR.Real-timeattitude—independentthree.axis
magnetometercalibration
[17]黄美发,景晖。匡兵,等.基于拟蒙特卡罗方法的测量不确定度评定[J].仪器仪表学报,2009,30(1):
120.125.
HUANGMF.JINGH.KUANGB,eta1.Measurement
[J].Journal
[6]
ofGuidance.ControlandDynamics,2005,
28(1):i15-120.
MUYJ,KOJP.Aninexpensiveandsitionsd'lsorfordriving
Oll
gtcclll'alE
absolutepe-Transactions
uncertaintyevaluationbased
on
quasiMonte・Carlomethod
assistance[J]IEEE
[J].ChineseJournal
(1):120-125
ofScientificInstrument,2009,30
InstrumentationandMeasurement
2008,57(4):864-8"/3.
[7]
PAPOULISchastic
A.Probability,randomvariables,andsto—
3rd
ed
McGraw.Hill,1977:
[18]吴德会,赵伟,黄松岭,等传感器动态建模FLANN方
法改进研究[J]仪器仪表学报,2009,30(2):
362-367.
process[M]
212-224.
[8]
LEEGW
UAVfliShttestofGPSattitudedetermination
2004
International
Symposium
on
WUDH,ZHAOW,HUANGSL,etal
improvedFLANNfor
Hese
sensor
Research
on
system[C]The
[9]
dynamic
modeling[J],Chi—
GNSS/GPS,2004:138・151.
Joumal
ofScientific
Instrument,2009,30(2):
刘危基于MEMS的低成本MIMU的应用研究[D].
长沙:国防科技大学。2004:32-38.
LIUW.Applicationstudy
oflow—cost
MIMU
based
on
362—367.
作者简介
University
ofDefense
MEMS[D].Changsha:National
Technology,2004:32-38.
[10]DJURICPM,KOTECHAJH.Particle
IEEESignalProcessing
filtering[J].
Real-time
Magazine,2003,20(5):19—38.
CRASSIDlSJL,LAIKL,HARMANRR
一一一一一
attitude—independentthine—axismagnetometercalibration
[J]Guid.Control
[12]
Dyn.,2005:115—120.
DAVIDJ,MARKOJ,ROMANK.Calibrationanddatafusionsolutionfortheminiatureattitudeandheadingref-
erence
system[J]Sensors
and
Actuators,2007,138
(2):411420.
[13]YUNJ。KOJ-P.AnInexpensiveandaccurateabsolute
position∞n80rfordriving
tions
on
assistance[J]IEEE
and
Transac—
Instrumentation
Meesurement,2008,57
(4):864-873
[14]
DA
R.Investigationof
a
low-costand
hi曲-accuracy
National
GPS/IMUTechnical955-963.
system[C].Proceedings
Meetingt
Santa
ofION
Moniea,California,2006:
一一一|萋一一是露ii黛
Fang
一~~一一
Jia叫anreceived
1998.Heis
[15]涂刚毅,余世俊,祝雪芬,等.基于改进粒子滤波算法的GPS非高斯伪距误差修正[J]电子测量与仪器学
报.2009,23(6):24-28
TUGY.JINSHJ.ZHUXF,eta1.CompensationofGPSnon・Ganssinnpseudoranga
elTor
alUniversityin1993andPh.D.fromChinaAgriculturalU.niversityin
now
a
Schoolof
Automation,Beijing
ale
searchinterestssystem.
robotics.MEMSandembeddedcontrol
一一一一一一
B.Sc
professorUnion
一一一~帆
fromHuazhongAgrieultur-
andthedeanof
re—
University.His
based
on
improved
万方数据
MEMS传感器随机误差Allan方差分析
作者:作者单位:刊名:英文刊名:年,卷(期):
高宗余, 方建军, 于丽杰, Gao Zongyu, Fang Jianjun, Yu Lijie北京联合大学自动化学院 北京100101仪器仪表学报
Chinese Journal of Scientific Instrument2011,32(12)
参考文献(18条)
1.ALLAN D W Statistics of atomic frequency standards[外文期刊] 1966
2.KO R Standard specification format guide and test procedure for single-axis interferometric fiber optic gyros1972
3.HOU H Modeling inertial sensors errors using AV 2004
4.WANG J H;GAO Y An intelligent MEMS IMU-based land vehicle navigation system enhanced by dynamics knowledge 20055.CRASSIDIS J L;LAI K L;HARMAN R R Real-time attitude-independent three-axis magnetometer calibration[外文期刊]2005(01)
6.MU Y J;KO J P An inexpensive and accurate absolute position sensor for driving assistance 2008(04)7.PAPOULIS A Probability,random variables,and stochastic process 19778.LEE G W UAV flight test of GPS attitude determination system 20049.刘危 基于MEMS的低成本MIMU的应用研究[学位论文] 2004
10.DJURIC P M;KOTECHA J H Particle filtering[外文期刊] 2003(05)
11.CRASSIDIS J L;LAI K L;HARMAN R R Real-time attitude-independent three-axis magnetometer calibration[外文期刊]2005(1)
12.DAVID J;MARKO J;ROMAN K Calibration and data fusion solution for the miniature attitude and heading referencesystem 2007(02)
13.YUN J;KO J-P An Inexpensive and accurate absolute position sensor for driving assistance 2008(04)14.DA R Investigation of a low-cost and high-accuracy GPS/IMU system 2006
15.涂刚毅;余世俊;祝雪芬 基于改进粒子滤波算法的GPS非高斯伪距误差修正[期刊论文]-电子测量与仪器学报 2009(06)16.吴永芝;余容红;李兴红 光电信号参数的动态提取方法[期刊论文]-电子测量与仪器学报 2009(05)17.黄美发;景晖;匡兵 基于拟蒙特卡罗方法的测量不确定度评定[期刊论文]-仪器仪表学报 2009(01)18.吴德会;赵伟;黄松岭 传感器动态建模FLANN方法改进研究[期刊论文]-仪器仪表学报 2009(02)
本文读者也读过(3条)
1. 任亚飞.柯熙政.REN Ya-fei.KE Xi-zhen 基于阿伦方差的微机电陀螺误差建模及其粒子滤波[期刊论文]-中国计量学院学报2009,20(2)
2. 于丽杰.高宗余.YU Li-jie.GAO Zong-yu MEMS传感器随机误差分析[期刊论文]-传感器与微系统2012,31(3)3. 张代兵 一种基于Allan方差方法的激光陀螺性能评价方法[期刊论文]-仪器仪表学报2004,25(z1)
引证文献(1条)
1.邸文华.刘昱.黄镇彩 基于iOS平台的步长计算方案与实现[期刊论文]-电子测量技术 2012(9)
本文链接:http://d.g.wanfangdata.com.cn/Periodical_yqyb201112035.aspx
第32卷第12期2011年12月
仪器仪表学报
VoL32No.12Dec.20ll
ChineseJournalofScientificInstrument
MEMS传感器随机误差Allan方差分析水
高宗余,方建军,于丽杰
(北京联合大学自动化学院北京100101)
摘要:MEMS传感器中随机误差较大,有时会覆盖传感器中有用信号,提出采用Allan方差(Allanvariance)方法对MEMS传感器实测数据进行分析,系统地分析了引起MEMS传感器误差的随机噪声种类及其来源和特性,确定其各项系数,根据系数获得其功率谱密度,根据功率谱密度分析法与Allan方差分析法获得对应各项随机误差的数学模型,然后以数学表达式的形式得到统一的数学模型,再与卡尔曼滤波相结合得到增强的卡尔曼滤波,最后通过车载实验对MEMS—INS/GPS各个姿态进行卡尔曼滤波与改进后卡尔曼滤波2种滤波方法的比较,实验结果表明新滤波方法能很好地提高微惯性系统各个姿态精度。关键词:MEMS;Allan方差;随机噪声;功率谱密度;数学模型中图分类号:TN253
文献标识码:A
国家标准学科分类代码:460.402
Allanvarianceanalysisforthestochastic
error
of
MEMS
sensors
GaoZongyu,FangJianjun,YuLijie
(The
College
ofAutomation,BeiiingUnionUniversity,Belling100101,China)
Abstract:Insomecases,largestochasticapproachas
a
errors
usuallyoverrideeffectivesignalsinMEMS¥ensol瞎.Allanvariance
timedomainhasbeenproposed
to
commonwayinanalyzingfrequencystabilityin
sources
analyzethedata
measurement
measuredwithMEMSsen¥or8anddescribethe
errors
andcharacteristicsofrandomnoisesthat
error
are
cause
ofMEMSsensors.Thecoefficientsofindividualstochastic
determinedusingAllanvarianceapproach
are
to
obtaintheirpowerspectraldensities.Meanwhile,themathematicalmodelsofallstochasticelTOrs
derivedin
combinationwithpowerspectraldensityanalysis.Aunifiedcalibrationmathematicalmodelisobtainedintheformofdifferentialequationformultiplestochasticelrors.AnenhancedKalmanfilterisdesignedeffectthroughincorporatingtheunfedcalibrationmodelintotraditionalMEMS-INSaland
error
to
obtainbetterfiltering
equation.Finally,tradition—
eIlIIanced
Kalmanfilters
are
applied
to
measuretheposesofMEMS—INS/GPSinvehicleexperimentsandresult
to
showsthat
enhanced
Kalmanfilterissuperior
traditional
one
inimprovingtheprecisionofmicroinertialnavigation.
Keywords:MEMS;Allanvariance;stochasticnoise;powerspectraldensity;mathematicalmodel
随机误差特性分析拉1。惯性导航(INS)系统能够高速地
1
引言
输出加速度及角速度,然而其精度会随着时间而退化,主要是由于不同的误差源,这些误差随着在惯导航算法中数据积分的积累,将会引起航向误差。因此对传感器误差的建模及估计变得异常重要。本文主要采用功率谱密度¨1(PSD)及Allan方差对MEMS.INS随机过程进行分析。首先对所采集的数据采用Allan方差法获得其特性曲线。此后通过对曲线分析以获得存在于数据集中的随
Allan方差…技术最初是为了研究精密仪器的频率稳定性而在19世纪60年代发展产生的,其有助于识别存在于测量仪器中的误差种类及大小。由于惯性传感器与这类仪器的类似性,这一方法已经应用于各类设备的
收稿日期:2010-02
ReceivedDate:20104)2
・基金项目:国家自然科学基金(50805004)、模式识别与智能机器人系统学术创新团队项目(PHR201107149)资助项目
万方数据
仪器仪表学报
第32卷
机误差的种类及大小,最后对随机误差进行识别、建模、计算出其系数及各类误差。在得到各个误差及系数后,采用单元白噪声对误差的微分方程进行描述,对于其中无理谱模型一刮进行微分近似,获得相应的各项误差数学模型,最后对其模型进行统一化,进而与卡尔曼滤波相结合得到增强卡尔曼滤波器;采用文中所述方法可得到精确的滤波效果,通过实验其精度得到提高,与GPS结合采用本文方法也可得到较准确的轨迹。
2
Allan方差概述
2.1功率谱密度(PSD)
PSD的主要特点在于描述时间序列的频谱特性,是一种分析数据及表示数据特性的方法,同时对随机误差模型的建立有重要作用。通过对一系列样本的自相关函数估值进行傅里叶变换可计算其相应的PSD。
2.2
Allan方差
在Allan方差数据分析中,假设数据的不确定性是由误差特性给出。每个误差源协方差的大小是由数据估值得来。AU肌方差详细的原理描述及怎样应用于时频分析领域可参考文献[7.8]。
Allan方差法只能确定每个独立误差源的特性,但是所有误差源需组成一个统一的校正模型以便于卡尔曼滤波对其进行校正。下面首先对传感器随机误差的微分方程进行推导。然后推导出多个随机误差的统一校正模型。3.1传感器随机误差的微分方程
Allan方差法和其后确定的惯性传感器随机误差的PSD参看文献[3],这里首先利用PSD来确定随机误差相应的微分方程。给出随机过程的PSD,滤波器的传递函数能够通过式(1)得到:
S。(∞)=IG(j∞)I
2
(1)
式中:S;(ccJ)为随机过程菇的PSD,G(jto)为滤波器的传
递函数,tO其值为2矶根据线性系统理论,下面关系式
成立:
Y(jw)=G(曲)X(j∞)
(2)
式中:Y(jw)是系统输出的傅里叶变换,x(j吐,)是系统输入的傅里叶变换。式(2)两端执行傅里叶逆变换,就可获得线性系统的微分方程。这里首先考虑最化噪声及角/速度随机游走。根据方程(1)和量化噪声的PSD,则量化噪声整形滤波器的传递函数为:
G。(jOJ)=j∞Q√r
(3)
由此量化噪声的微分方程为:
万方数据
d。(t)=Q√%(t)
(4)
式中:H(t)为单元白噪声,Q为鼍化噪声系数。角速率随机游走及速度随机游走分别是角速度及加速度的白噪声。根据卡尔曼滤波理论,它们可以直接与INS姿态误差方程及速度误差方程相结合。对于其余3类噪声,分别对2种情况进行处理:有理谱形式及无理谱形式。对于角速率/)Jn速度随机游走,PSD是有理谱,通过圆周率代替频率可重写为:
一
S。(∞)=竺2
∞
(5)
根据方程(1),相应的整形滤波器的传递函数为:
五,
G,(jcc,)=导
(6)
J叫
因此角速度随机游走及加速度随机游走的微分方程
可表示如下:
d。=Ku。(t)
(7)
式中:“.(t)为单元白噪声,K为其噪声系数。对与闪烁噪声和斜坡噪声,PSD是无理谱,因此选择一阶高斯马尔科夫过程来近似实际的闪烁噪声过程,用二阶高斯马尔科夫一1来近似实际的斜坡噪声过程。对于闪烁噪声,采用一阶马尔科夫过程近似为:
d向(£)+卢d历(t)=flBu:(t)
(8)
式中:口是互相关时间,需要确定;口是闪烁噪声系数;Ⅱ:(t)是单元白噪声。对于斜坡噪声,采用二阶高斯马尔科夫过程来近似:
d。(t)+√r2∞od。(t)+∞02d。(t)=Ru3(t)
(9)
式中:尺是梯度噪声系数,∞。是需要确定的二阶系统的固有频率,n,(£)是单元白噪声,由此,推出了角速率/)JD速度随机游走、闪烁噪声和梯度噪声微分方程如式(7)、
(8)和(9)所示。
3.2统一的校正模型
量化噪声、角速率/加速度随机游走、闪烁噪声及斜坡噪声是否可以同时存在于一个传感器中取决于实际数据的Allan方差分析。这些随机噪声的微分方程通过方程(7)、(8)、(9)表示,为方便起见我们采用微分算子来表示:
“¨半
讪)=黜
(10)
d,(t)=矿币Ru而3(t)
式中:D是微分算子。定义新的函数:(t)如下:
z(t)=d。(t)+如(f)+d,(£)
(11)参考文献[10—11]进行整理可得到3项噪声融合的
等价随机误差模型为:
3建立统一校正模型
第12期
高宗余等:MEMS传感器随机误差Allan方差分析
:‘4’(f)+口Iz‘3’(f)+屹∥(t)+口3z‘1’(t)+a4z‘o’(t)=
bot03(t)+6I∞2(t)+62∞1(f)+63∞o(t)(12)
4
GPS/MEMS・INS组合的扩展卡尔曼滤波
本节主要推导出结合随机误差模型的GPS/MEMS.
INS误差方程,可通过前面部分所述的惯性传感器方程
,。=[三至手三妻],G,=[萎],日。=[享]7
b32b3b2
b3bI
b3bob2b3
b22626Ib2bo
Q,.(r)=
(17)
6Ib3
6Ib2612
blbo
bob3
bob2
bobI
b02
为了便于与式(13)相结合,对式(15)进行离散化:zl(蠡+1)=也。,.(知,k+1)工l(知)+G1鸭.(知)
(18)zl(k)=日。工l(后)
(19)
式中:咖。.(后,k+1)=e7‘缸=I+,。△t,缸是离散化后的样本间隔,离散过程的噪声协方差矩阵为:
Q。.(后)*Q,.(r)At
(20)
毛(k),i=2,…,6的状态空间可根据以上对z。(后)的
万方数据
处理方式获得。扩展MEMS-INS误差方程式为:
[浆》∥七乎“’删qbn,(k¨,k+1。,)】×嘲r<k).1+【:搦(21)
式中:咖w(蠡,I|}+1)是初始系统的状态转移矩阵,与方程
(12)所述一致;如(七,k+1)为:
“(后,k+1):『03×24。风。M1
1,如(五,||}+1)是斜对角矩
阵:
,xx(后,k+1)=diag(屯."…,屯^)(22)
噪声协方差矩阵为:
鲫,=电2】
∞,
式中:Q,是噪声协方差矩阵,用于说明初始系统的量化
噪声、角/速度随机游走噪声。Q。是斜对角矩阵:
级=diag(Q,.…Q.)(24)
5实验仿真
本文中实验为MEMS.INS/GPS组合,其主要器件为MEMS三轴惯性器件及GPS系统。这部分首先对传感器随机误差系数进行计算,其次采用文中所述方法对MEMS.INS/GPS姿态误差进行实验仿真,最后对组合惯性导航运
行轨迹进行实验仿真。首先以量化噪声为例根据Allan方差法计算其误差系数,利用图1参考文献[1,14-15]获得在矿(r)一r的重对数图上的量化噪声系数。这里图2及图3分别为MEMS传感器及加速度计6h的数据测试的Allan方差图,其相应的各个系数如表1及表2所示。
图1
z轴陀螺量化噪声系数结果
Fig.1ZaxisgymAllanvarianceresultwithslopeof-1
仪器仪表学报
第32卷
图2
MEMS陀螺Allan方差结果Fig.2
MEMSgyroAU叽varianceresults
图3
MEMS加速度Allan方差结果
Fig.3MEMSaccelerometerAⅡ蚰variKilceresults
表1陀螺辨识误差系数
陀螺量化噪声(。)堡铲专考器芋
Table1Gyroidentification
error
coefficients
x轴口,=II.385
Q,=16.476
Q;=13.225
y轴
B,=0.02054
B,=0.02001
B。=0.01204
兰垫生三!丝:!
墨z三竺:兰生:型:!
表2加速度计的辨识误差系数
Table2Accelerometer
identification
error
coefficients
加速度毪警氅学黛竽耘
y轴
1.888×10一
I.805×10~
1.735×10+3
兰塾
竺三!丝垒三竺笠三!:
万方数据
表3陀螺5次测试量化噪声
Table3Gyroquantizationnoiseforfivetests(o)
接下来采用文中上述方法对实际惯性传感器系统建h。根据相应的噪如(t)+例m(t)=flBu2(t)
(25)d,(t)=Ku。(t)
(26)
%‘2’(t)+敝‘1’(t)=
/酽+卢mB∞。‘1’(‘)+脚。‘0’(t)
(27)
根据式(15)及式(27),陀螺菇轴的统一校正模型的
工F(t)=F酽X伊(t)+GFn,弘(t)
(28)z,(t)=如&(£)
(29)
系数矩阵为:
Fp=【:?8】
(30)
G,-[邵缸2+矿日2]7
(31)日。=[0
1]
(32)
根据式(30),噪声协方差矩阵为:
蹦加[邸磊印磊卵∽,
对式(28)、式(29)进行离散化:
“后+1)=(二。。三At)“后)+G。%(后)
(34)
立校正模型。对惯性系统采集数据10声系数获得噪声的微分方程。最后获得多个随机噪声的
统一校正模型并且推导出惯性传感器系统的扩展卡尔曼滤波。这里,首先推出随机噪声的微分方程。根据以上分析,在测试中对陀螺需考虑3种随机噪声,分别是:角随机游走、闪烁噪声及角速率随机游走;对加速度计需考虑4种随机噪声,分别是:量化噪声、速率随机游走、闪烁噪声及加速度随机游走。这里只对陀螺菇轴进行详细分析。根据式(7)、式(8),陀螺髫轴的闪烁噪声和角速率随机游走微分化为:
式中:B和K分别为闪烁噪声和角速率随机游走的统一校正模型,是式(11)的低阶表示,其系数可通过把R=0及tO。=0代入参考文献[12・13,16-18]中的相关公式得到。因此陀螺茗轴的统一校正模型为:
状态空间为:
第12期
高宗余等:MEMS传感器随机误差Allan方差分析
2867
Z萨(后)=[01]工。(后)
(35)
州牝[邵,/品r2
离散化后噪声协方差矩阵为:
邸 ̄/酽+矿曰2Atl
o邸
+∥2
BAt(r+矿曰2)At
1
(36)
陀螺其他轴及各向加速度离散化校正模型都可通过上述过程获得。对所有离散化校正模型加以组合,即可获得式(21)所示的扩展卡尔曼滤波模型,可用于MEMS.INS/GPS组合中。这里采用新模型对MEMS—INS/GPS进行姿态分析,采用上述数据模型对2种情况进行对比数据采用实测数据,误差系数采用MEMS器件标准系数及文中所述方法计算所得系数进行滤波比较,分别比较了km/h的速度绕着方形000
m,各个姿态误差如图4—9所示。
图4北向位置误差
Fig.4Errorsofnorthposition
图5东向位置误差
Fig.5Errorsofeastposition
图6北向速度误
Fig.6Errorsofnorthvelocity
万方数据
0
,0
7
0E
0
≤
吣
-o-0
tfs
图7东向速度误差
Fig.7Errorsofeastvelocity
图8北向姿态误差(横滚)
Fig.8Errorsofnorth
attitude(roll)
图9东向姿态误差(俯仰)
Fig.9Errorsofeast
attitude(pitch)
测量结果表明采用文中所述的方法及模型对系统性论
文中主要在几个方面讨论了Allan方差在MEMS惯参考文献
ALLANDW.Statisticsofatomicfrequencystandards
[C].Proceedings
oftheIEEEInternationalSymposium,
NewYork,USA,1966(54)’:221-230.
6种状态,在试验中车载体以20操场运行1
能有很大改善,更接近实际的状况。
6结
性传感器校正模型建立中的应用:首先,辨识传感器误差源及确定相应的噪声参数;其次,推导出单个随机误差的微分方程;然后,对混有多个随机误差的系统求出了统一的校正模型;最后,对2种方法进行比较说明。增强卡尔曼滤波能够对MEMS.INS/GPS组合中的各个姿态误差进行优化,实验结果表明j由于采用了真实的随机误差,卡尔曼滤波的结果更加精确,其组合运行轨迹也能更好的
接近真实轨迹。
[1]
2868
仪器仪表学报
KOR.Standardspecificationformatguideandtestproce—durefor
particlefilter
urement
第32卷
algorithm[J].Journal
ofElectronicMeas-
[2]
sin#e.axisinterferometricfiberopticgyros[M].
[16]
AV[D].
andInstrument。2009.23(6):24-28
USA:IEEEStd.,1972:952—1977.
吴永芝,余容红.李兴红,等光电信号参数的动态提取方法[J].电子测量与仪器学报,2009,23(5):
69-73
[3]HOUH.Modelinginertial"n¥oPJ
errors
using
Canada:Univ.Calgary。2004:182・188.
[4]WANGJH。GAOY.AnintelligentMEMSIMU—basedland
vehiclenavigationsystemenhancedbydynamicsknowledge
WUYzH,YURH.LIXH,eta1.DyllⅢllicextracting
methodofphotoelectrici811aIleetronicMeasurementand
pammet∞[J].Journal
ofE-
[C].Proc.US
[5]
ION61stAnnMeeting,2005:27-29.Instrument,2009,23(5):69-73
CRASSIDISJL.LAIKL.HARMANRR.Real-timeattitude—independentthree.axis
magnetometercalibration
[17]黄美发,景晖。匡兵,等.基于拟蒙特卡罗方法的测量不确定度评定[J].仪器仪表学报,2009,30(1):
120.125.
HUANGMF.JINGH.KUANGB,eta1.Measurement
[J].Journal
[6]
ofGuidance.ControlandDynamics,2005,
28(1):i15-120.
MUYJ,KOJP.Aninexpensiveandsitionsd'lsorfordriving
Oll
gtcclll'alE
absolutepe-Transactions
uncertaintyevaluationbased
on
quasiMonte・Carlomethod
assistance[J]IEEE
[J].ChineseJournal
(1):120-125
ofScientificInstrument,2009,30
InstrumentationandMeasurement
2008,57(4):864-8"/3.
[7]
PAPOULISchastic
A.Probability,randomvariables,andsto—
3rd
ed
McGraw.Hill,1977:
[18]吴德会,赵伟,黄松岭,等传感器动态建模FLANN方
法改进研究[J]仪器仪表学报,2009,30(2):
362-367.
process[M]
212-224.
[8]
LEEGW
UAVfliShttestofGPSattitudedetermination
2004
International
Symposium
on
WUDH,ZHAOW,HUANGSL,etal
improvedFLANNfor
Hese
sensor
Research
on
system[C]The
[9]
dynamic
modeling[J],Chi—
GNSS/GPS,2004:138・151.
Joumal
ofScientific
Instrument,2009,30(2):
刘危基于MEMS的低成本MIMU的应用研究[D].
长沙:国防科技大学。2004:32-38.
LIUW.Applicationstudy
oflow—cost
MIMU
based
on
362—367.
作者简介
University
ofDefense
MEMS[D].Changsha:National
Technology,2004:32-38.
[10]DJURICPM,KOTECHAJH.Particle
IEEESignalProcessing
filtering[J].
Real-time
Magazine,2003,20(5):19—38.
CRASSIDlSJL,LAIKL,HARMANRR
一一一一一
attitude—independentthine—axismagnetometercalibration
[J]Guid.Control
[12]
Dyn.,2005:115—120.
DAVIDJ,MARKOJ,ROMANK.Calibrationanddatafusionsolutionfortheminiatureattitudeandheadingref-
erence
system[J]Sensors
and
Actuators,2007,138
(2):411420.
[13]YUNJ。KOJ-P.AnInexpensiveandaccurateabsolute
position∞n80rfordriving
tions
on
assistance[J]IEEE
and
Transac—
Instrumentation
Meesurement,2008,57
(4):864-873
[14]
DA
R.Investigationof
a
low-costand
hi曲-accuracy
National
GPS/IMUTechnical955-963.
system[C].Proceedings
Meetingt
Santa
ofION
Moniea,California,2006:
一一一|萋一一是露ii黛
Fang
一~~一一
Jia叫anreceived
1998.Heis
[15]涂刚毅,余世俊,祝雪芬,等.基于改进粒子滤波算法的GPS非高斯伪距误差修正[J]电子测量与仪器学
报.2009,23(6):24-28
TUGY.JINSHJ.ZHUXF,eta1.CompensationofGPSnon・Ganssinnpseudoranga
elTor
alUniversityin1993andPh.D.fromChinaAgriculturalU.niversityin
now
a
Schoolof
Automation,Beijing
ale
searchinterestssystem.
robotics.MEMSandembeddedcontrol
一一一一一一
B.Sc
professorUnion
一一一~帆
fromHuazhongAgrieultur-
andthedeanof
re—
University.His
based
on
improved
万方数据
MEMS传感器随机误差Allan方差分析
作者:作者单位:刊名:英文刊名:年,卷(期):
高宗余, 方建军, 于丽杰, Gao Zongyu, Fang Jianjun, Yu Lijie北京联合大学自动化学院 北京100101仪器仪表学报
Chinese Journal of Scientific Instrument2011,32(12)
参考文献(18条)
1.ALLAN D W Statistics of atomic frequency standards[外文期刊] 1966
2.KO R Standard specification format guide and test procedure for single-axis interferometric fiber optic gyros1972
3.HOU H Modeling inertial sensors errors using AV 2004
4.WANG J H;GAO Y An intelligent MEMS IMU-based land vehicle navigation system enhanced by dynamics knowledge 20055.CRASSIDIS J L;LAI K L;HARMAN R R Real-time attitude-independent three-axis magnetometer calibration[外文期刊]2005(01)
6.MU Y J;KO J P An inexpensive and accurate absolute position sensor for driving assistance 2008(04)7.PAPOULIS A Probability,random variables,and stochastic process 19778.LEE G W UAV flight test of GPS attitude determination system 20049.刘危 基于MEMS的低成本MIMU的应用研究[学位论文] 2004
10.DJURIC P M;KOTECHA J H Particle filtering[外文期刊] 2003(05)
11.CRASSIDIS J L;LAI K L;HARMAN R R Real-time attitude-independent three-axis magnetometer calibration[外文期刊]2005(1)
12.DAVID J;MARKO J;ROMAN K Calibration and data fusion solution for the miniature attitude and heading referencesystem 2007(02)
13.YUN J;KO J-P An Inexpensive and accurate absolute position sensor for driving assistance 2008(04)14.DA R Investigation of a low-cost and high-accuracy GPS/IMU system 2006
15.涂刚毅;余世俊;祝雪芬 基于改进粒子滤波算法的GPS非高斯伪距误差修正[期刊论文]-电子测量与仪器学报 2009(06)16.吴永芝;余容红;李兴红 光电信号参数的动态提取方法[期刊论文]-电子测量与仪器学报 2009(05)17.黄美发;景晖;匡兵 基于拟蒙特卡罗方法的测量不确定度评定[期刊论文]-仪器仪表学报 2009(01)18.吴德会;赵伟;黄松岭 传感器动态建模FLANN方法改进研究[期刊论文]-仪器仪表学报 2009(02)
本文读者也读过(3条)
1. 任亚飞.柯熙政.REN Ya-fei.KE Xi-zhen 基于阿伦方差的微机电陀螺误差建模及其粒子滤波[期刊论文]-中国计量学院学报2009,20(2)
2. 于丽杰.高宗余.YU Li-jie.GAO Zong-yu MEMS传感器随机误差分析[期刊论文]-传感器与微系统2012,31(3)3. 张代兵 一种基于Allan方差方法的激光陀螺性能评价方法[期刊论文]-仪器仪表学报2004,25(z1)
引证文献(1条)
1.邸文华.刘昱.黄镇彩 基于iOS平台的步长计算方案与实现[期刊论文]-电子测量技术 2012(9)
本文链接:http://d.g.wanfangdata.com.cn/Periodical_yqyb201112035.aspx