文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > IT/计算机 > 速度计的陀螺仪漂移补偿算法的研究
侵权投诉

速度计的陀螺仪漂移补偿算法的研究

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)

万方数据 

第1页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email