42
传感器与微系统(TransducerandMicrosystemTechnologies)2009年第28卷第12期
基于六加速度计的陀螺仪漂移补偿算法的研究半
李启光,张海龙,郝静如
(北京信息科技大学机电工程学院。北京100192)
摘要:为满足机动无人机姿态测量的需求,尝试了一种新的陀螺仪漂移补偿方案:对6只加速度计按回转轴对称布局,从而解算出角速度;并利用Kalman滤波对该解算角速度与陀螺仪的输出进行融合,通过反馈校正来实现对陀螺仪漂移的补偿。仿真结果证明:该方案能有效补偿陀螺仪漂移,具有一定工程应用价值。
关键词:卡尔曼滤波;陀螺仪;加速度计;漂移补偿;算法中图分类号:V249.32
文献标识码:A
文章编号:1000-9787(2009)12--0042-03
Researchbased
on
on
algorithmofdriftcompensationgyroscopewithsixaccelerometers木
LI
the
Qi—guang,ZHANGHai—long,HAOJing—ru
(DepartmentofMechanicalEngineering,BeijingInformationScience&TechnologyUniversity,
Beijing100192,China)
ofattitude
forgyro
Abstract:Inorder
tomeettheneed
are
measuringofUAV,a
on
new
compensation
solutionis
attempted,sixaccelerometersTheangularvelocitycompensationis
is
arrangedsymmetrically
the
valueof
theaxisofrotation,thenangularvelocityisresolved.by
using
Kalmanfilter,then
show
the
fusedwithby
gyroscope
gyroscopedrift
can
achievedfeedback
outputemendation.The
simulationresultsthatthesolution
effectivelycompensatedriftofthegyro.Ithasvalueinengineering.
Keywords:Kalmanfilter;gyroscope;accelerometer;driftcompensation;algorithm
0引言
而言,在载体无机动加速度时,利用加速度计的测量值可以直接求得载体的俯仰角和横滚角,如载体的横滚角咖可由下式得到
西=arcsin(f:/g),
(1)
MEMS惯性传感器具有体积小、重量轻、功耗小、启动快、成本低和可靠性高的优点,所以,基于MEMS传感器的小型化航姿测量系统成为航拍无人飞行器的首选。但在航测系统中,低成本微机械陀螺仪存在较大的漂移误差,长时间的积分会导致测量姿态发散,不能保证良好的航拍效果。而加速度计除了可以输出加速度值外,在一定的情况下,经过一定的解算还可以用于倾角测量刚。但由于它同时对重力加速度和运动加速度敏感,载体做长时间机动运动时,上述姿态测量系统会产生较大的测量误差∽J。文献[3]利用GPS信号作为姿态参考向量来解决该问题,补偿了机动加速度带来的姿态误差。本文尝试在特定环境下,通过增加加速度计的数量,并进行合理布局,来实现对陀螺仪漂移的补偿。
1加速度计位置布局
对于3只加速度计分别位于3个回转轴上的常规布局
式中正为z轴加速度计输出值,g为重力加速度。但是,这是利用地球重力加速度在载体系三轴的分量信息来反映载体的姿态信息的。因此,这个方案理论上只有在载体无机动加速度的情况下才成立。而在实际系统中,载体并不是保持静止或匀速运动的,一旦载体有了机动运动,就不再与重力加速度在载体系三轴分量一一对应,而含有了加速运动的信息,利用它们就不能直接求得载体的姿态信息了,在机动状态下,加速度计不能区分重力加速度和运动加速度,由式(1)计算所得的姿态会产生较大误差。
基于此,本文根据航拍无人飞行器实际航拍运行状态,通过对加速度计位置重新布局,经计算获取具有一定可信度的角速率,利用此冗余信息,借助Kalman滤波,实现对陀
收稿日期:2009-10-20
基金项目:北京人材强教一中青年骨干教师计划资助项目(PXM2009_014224-073059)
万方数据
基于六加速度计的陀螺仪漂移补偿算法的研究_机械/仪表_工程科技_专业资料。陀螺仪,加速度计,磁通门,测量42 传感器与微系统 ( T ransducer andM icro syste T ...
陀螺仪零点漂移分析与补偿本研究运用卡尔曼滤波算法原理对陀螺仪 (1)将陀螺仪...基于陀螺仪及加速度计信... 5页 免费 用“卡尔曼滤波器”来处... 6页 免费...
基于陀螺仪和加速度计的飞行机器人自平衡算法研究-曹珂杰-南京工程学院_工学_高等...wg 为陀螺仪测量噪声,wa 为加速度计测量噪声,b 为陀螺仪漂移误差,wg 与 wa...
的施矩速度, 导致陀螺在 运行中产生严重的陀螺漂移...陀螺仪零点漂移分析与补偿本研究运用卡尔曼滤波算法...MEMS 传感器随机误差 Allan 方 差分析 [J] . ...
马尔科夫过程漂移 模型同陀螺仪模型 由加速度计惯导系统算法我们可以根据初始 速度和连续两点的加速度值推算出我们的角度信 下面我们来研究一下算法的精度 .息, 根...
通过分析温度变化对微机械陀螺仪的影响, 推导出陀螺输出、驱动轴相位与温度的关系, 提出了一种无温度传感器的新型补偿算法, 经温度实验补偿后的陀螺温度漂移减小到...
陀螺仪与加速度计的测试目的与意义_物理_自然科学_...的漂移率,都是指没有规律 或无法 补偿的随机漂移...1〞~1.5 中航工业北京航空精密机械研究所生产的 ...
通过卡尔曼滤波器对传感器数据进行补偿和信息融合, ...b 为陀螺仪漂移误差, w g 与 w a 相互独立, ...多传感器自适应滤波融合算法 [ J] . 电子与信息...
对加速度传感器温度漂移及系统振动和 机械噪声等方面...为了克服这些问题,数据融合算法需 使用加速度传感器...基于MEMS加速度计和陀螺仪的姿态检测系统 研究与开发...
陀螺仪输出的角速度x t 对应式 ( 1) 中的状态变量...计, 即两种滤波算法是在不改变信号均值的前提下, ...EM S 陀螺仪随机漂移误差补偿中的应用研究 [J ] ...
热门文档