陀螺仪”和“加速度计”工作原理.docx

陀螺仪”和“加速度计”工作原理 2016-09-17 16:14:40 作者：没有夏天的四叶草 ? ? ? ? ? ? 修改：小马hoty ? ? ? ? ? ? ? ? ? 时间：2016/1/10 ? ? ? ??最近看到加速度计和陀螺仪比较火，而且也有很多人都在研究。于是也在网上淘了一个mpu6050模块，想用来做自平衡小车。可是使用起来就发愁了。网上关于mpu6050的资料的确不少，但是大家都是互相抄袭，然后贴出一段程序，看完之后还是不知道所以然。经过翻阅各个方面的资料，以及自己的研究在处理mpu6050数据方面有一些心得，在这里和大家分享一下。 1、加速度和陀螺仪原理 ? ? ? ?当然，在开始之前至少要弄懂什么是加速度计，什么是陀螺仪吧，否则那后边讲的都是没有意义的。简单的说，加速度计主要是测量物体运动的加速度，陀螺仪主要测量物体转动的角速度。这些理论的知识我就不多说了，都可以在网上查到。这里推荐一篇讲的比较详细的文章《AGuide To using IMU (Accelerometer and Gyroscope Devices) inEmbeddedApplications》，在网上可以直接有哪些信誉好的足球投注网站到。 2、加速度测量 ? ? ? ?在开始之前，不知大家是否还记得加速度具有合成定理？如果不记得可以先大概了解一下，其实简单的举个例子来说就是重力加速度可以理解成是由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°，∠b+∠d=90°于是轻松的就可以得出：∠a=∠d。 ? ? ? ?所以计算出角度d就等效于计算出了x轴与桌面的夹角a。根据正弦定理得出：sin（d）=gx/g。得到这个公式可是还是得不到想要的角度，因为需要计算反正弦，而反正弦在单片机里不是很好计算。 ? ? ? ?为了得到角度，于是又查了相关资料，原来在角度较小的情况下，角度的正弦与角度对应的弧度成线性关系。如图四： ?图四 这个图x轴是角度，取值范围是0~90度，有三个函数曲线，分别是： y = sin(x) ? ? ? ? ? ? ? ? ? ? ? ? ? 正弦曲线 y = x*π/180 ? ? ? ? ? ? ? ? ? ? ? 弧度 y = 0.92*x*π/180 ? ? ? ? ? ? ? 乘以一个0.92系数的弧度 从图上可以看出，当角度范围是0~29度时，对于自平衡车来说摆动范围在-29~29度之内sinx = x*3.14/180可用来代替y = sinx；如果超过这个范围，小车姿态也无法调整。当然有时候也会担心-29~29度的摇摆范围还是无法