MPU6050数据轻松分析.docx

MPU6050数据轻松分析————————————————————————————————作者:————————————————————————————————日期: MPU6050数据轻松分析这个文章是根据自己学****查资料的汇总,同时把一些自己的心得加进去。如果有什么不对的,欢迎请大家指正、交流。邮箱:ount@最近看到加速度计和陀螺仪比较火,而且也有很多人都在研究。于是也在网上淘了一个mpu6050模块,想用来做自平衡小车。可是使用起来就发愁了。网上关于mpu6050的资料的确不少,但是大家都是互相抄袭,然后贴出一段程序,看完之后还是不知道所以然。经过翻阅各个方面的资料,以及自己的研究在处理mpu6050数据方面有一些心得,在这里和大家分享一下。在处理加速度计和陀螺仪用到的方法都是比较简单的,这里的简单并不是不需要任何基础知识,只是这些基本知识都是最基本的,比如简单的三角函数,数学计算,物理知识,c语言以及基本的arduino知识(如果不会arduino会其它单片机也是一样的,本文实践是使用arduino),如果还不具备这些知识那就快去补课吧。加速度和陀螺仪原理当然,在开始之前至少要弄懂什么是加速度计,什么是陀螺仪吧,否则那后边讲的都是没有意义的。简单的说,加速度计主要是测量物体运动的加速度,陀螺仪主要测量物体转动的角速度。这些理论的知识我就不多说了,都可以在网上查到。这里推荐一篇讲的比较详细的文章《AGuideTousingIMU(AccelerometerandGyroscopeDevices)inEmbeddedApplications》,在网上可以直接搜索到。加速度测量在开始之前,不知大家是否还记得加速度具有合成定理?如果不记得可以先大概了解一下,其实简单的举个例子来说就是重力加速度可以理解成是由x,y,z三个方向的加速度共同作用的结果。反过来说就是重力加速度可以分解成x,y,z三个方向的加速度。加速度计可以测量某一时刻x,y,z三个方向的加速度值。而自平衡小车利用加速度计测出重力加速度在x,y,z轴的分量,然后利用各个方向的分量与重力加速度的比值来计算出小车大致的倾角。其实在自平衡小车上非静止的时候,加速度计测出的结果并不是非常精确。因为大家在高中物理的时候都学过,物体时刻都会受到地球的万有引力作用产生一个向下的重力加速度,而小车在动态时,受电机的作用肯定有一个前进或者后退方向的作用力,而加速度计测出的结果是,重力加速度与小车运动加速度合成得到一个总的加速度在三个方向上的分量。不过我们暂时不考虑电机作用产生的运动加速度对测量结果的影响。因为我们要先把复杂的事情分解成一个个简单的事情来分析,这样才能看到成果,才会有信心继续。下边我们就开始分析从加速度得到角度的方法。如下图,把加速度计平放,分别画出xyz轴的方向。这三个轴就是我们后边分析所要用到的坐标系。把mpu6050安装在自平衡车上时也是这样的水平安装在小车底盘上的,假设两个车轮安装时车轴和y轴在一条直线上。那么小车摆动时,参考水平面就是桌面,并且车轴(y轴)与桌面始终是平行的,小车摆动和移动过程中y轴与桌面的夹角是不会发生变化的,一直是0度。发生变化的是x轴与桌面的夹角以及z轴与桌面的夹角,而且桌面与x轴z轴夹角变化度数是一样的。所以我们只需要计算出x轴和z轴中任意一个轴的夹角就可以反映出小车的倾斜的情况了。为了方便分析,由于y轴与桌面夹角始终不变,我们从y轴的方向俯看下去,那么这个问题就会简化成只有x轴和z轴的二维关系。假设某一时刻小车上加速度计(mpu6050)处于如下状态,下图是我们看到简化后的模型。在这个图中,y轴已经简化和坐标系的原点o重合在了一起。我们来看看如何计算出小车的倾斜角,也就是与桌面的夹角a。上图g是重力加速度,gx、gz分别是g在x轴和z轴的分量。由于重力加速度是垂直于水平面的,得到:角a+角b=90度X轴与y轴是垂直关系,得到:角c+角b=90度于是轻松的就可以得出:角a=角c根据力的分解,g、gx、gz三者构成一个长方形,根据平行四边形的原理可以得出:角c=角d所以计算出角度d就等效于计算出了x轴与桌面的夹角a。前边已经说过gx是g在x轴的分量,那么根据正弦定理就可以得出:Sind=gx/g得到这个公式可是还是得不到想要的角度,因为需要计算反正弦,而反正弦在单片机里不是很好计算。为了得到角度,于是又查了相关资料,原来在角度较小的情况下,角度的正弦与角度对应的弧度成线性关系。先看看下边的图:这个图x轴是角度,取值范围是0~90度,有三个函数曲线,分别是:Y=sinx正弦曲线Y=x*=*x*,当角度范围是0~29度时:sinx=x*