mpu-6050 加速度、陀螺仪传感器的调试

 

——————————

 

 MPU-6000为全球首例整合性6轴运动处理组件，相较于多组件方案，免除了组合陀螺仪与加速器时之轴间差的问题，减少了大量的包装空间。MPU-6000整合了3轴陀螺仪、3轴加速器，并含可藉由第二个I2C端口连接其他厂牌之加速器、磁力传感器、或其他传感器的数位运动处理(DMP: Digital Motion Processor)硬件加速引擎，由主要I2C端口以单一数据流的形式，向应用端输出完整的9轴融合演算技术 。

 

MPU-6000的角速度全格感测范围为±250、±500、±1000与±2000°/sec (dps)，可准确追緃快速与慢速动作，并且，用户可程式控制的加速器全格感测范围为±2g、±4g±8g与±16g。产品传输可透过最高至400kHz的I2C或最高达20MHz的SPI。 

MPU-6000可在不同电压下工作，VDD供电电压介为2.5V±5%、3.0V±5%或3.3V±5%，逻辑接口VVDIO供电为1.8V± 5%。MPU-6000的包装尺寸4x4x0.9mm(QFN)，在业界是革命性的尺寸。其他的特征包含内建的温度感测器、包含在运作环境中仅有±1%变动的振荡器。

 

——————————————

 

总的来说，6050算是现在比较便宜好用的加速度陀螺仪芯片了，但是直接读取时噪声大，需要进行滤波。因此开始还找了一下卡尔曼滤波方面的资料，并且在网上发现了一种做好的6050+卡尔曼滤波集成的模块，不贵，35-58元，从网站的图片看效果很好，而且输出改成了串口，连接比较简单。刚看到有人对此提出质疑：，觉得其实就是用了一块8位的stm8调用了6050自带的dmp功能。模块的采样率100hz，后面说的dmp也可以做到。呵呵，谁对谁错就不好说了，不过用这个模块省了自己琢磨dmp了，懒人福音吧。用卡尔曼动态滤波算法，或者简化版的滤波，这种方法用好了效果会非常好，有些参数可以根据实际应用进行调整，改进效果。另一种是利用MPU6050内部的姿态融合器DMP，直接输出姿态角，优点是CPU参与少，但融合参数不可调整，调试困难（主要是可参考的资料很少）。

 

连线：首先把6050和arduino连起来，6050模块有8个插口，不用都用到，只需要把SCL和SDL连在A5和A4端就可以用了，有时需要中断时，把INt和D2连接，如下图。

 

 

Jeff Jrowberg 的DMP库（库名 MPU6050 I2C device class, 6-axis MotionApps20.h；当然这个库不是AVR的）,这个库，是作者通过“反向工程“得到的，不是官方的！

如果你仔细读Jeff Jrowberg的代码，其实就是i2c操作，先设置6050寄存器，再在6050内存中写入firmware，然后是config，最后是update，然后就可以直接读出FIFO里的quarternion数据，当然还有gyro和accel数据！注意，陀螺仪数据是可以自动校正，只需要传感器8秒保持不动即可，四元数处理后得到的角度数据是非常稳定的！自动校正功能是在DMP模式下才有的.

MPU-6050内部的DMP运算，roll和pitch两个参数，用了片内的加计（重力）对陀螺仪数据进行了校正，而yaw轴就没有相应的校正参考，陀螺仪的输出会漂移是很正常的，只能采用磁感传感器校正（使用invensense的9轴DMP或自己校正）!很不莘，当你用5883时，请一定记得先将5883做8字校准，不然你的YAW轴不会得到能用的数据的！

——————

 

9轴mpu-9150要贵一些，但是集成了地磁传感器。也可以用别的磁场传感器，后面可以试试。先说说直接读取的数据吧。导入I2Cdev.h和mpu6050.h两个库函数，运行示例程序，可以得到三个轴的角速度和加速度。数据的波动比较大，见图。ax-az是加速度，单位10E-3 g，gx-gz是角速度。未经滤波处理的数据是不能直接用的。而且如何从这6个参数得到模型的空间姿态，也是很麻烦的，后面摘抄了一段相关帖子，说的比较明白。

 

 

 

    Serial.print(ax/16.384); Serial.print(",");

 

    Serial.print(ay/16.384); Serial.print(",");

 

    Serial.print(az/16.384); Serial.print(",");

 

    Serial.print(gx/131); Serial.print(",");

 

    Serial.print(gy/131); Serial.print(",");

 

    Serial.println(gz/131);

 

未经处理的数据：

 

mpu-6050 加速度、陀螺仪传感器的调试（1）

dmp后得到的欧拉角：

mpu-6050 加速度、陀螺仪传感器的调试（1）

 

 

 

MPU6050模块是InvenSense公司推出的一款低成本的6轴传感器模块，包括三轴加速度，三轴角速度。其体积小巧，用途非常广。做平衡小车，四轴飞行器，飞行鼠标等等，都是必不可少而且是最优的传感器解决方案。本人根据自己的一些实际工作经验和使用体会来谈谈MPU6050的相关问题吧，抛砖引玉，如有不当之处，欢迎大家批评指正。

 

不论是做平衡还是四轴飞行器，关键的问题在于两方面，一是模块姿态的确定，通常需要用到积分运算与卡尔曼滤波算法，需要较强的数学功底与编程能力，二是稳定控制，方法比较单一，就是经典的PID控制算法，难点在于需要根据实际情况调整PID的参数，需要做实验确定，不难，只是费时间。因此以下主要分析姿态确定问题。

 

虽然6050模块能够输出三轴加速度和三轴角速度的数据，但实际应用的时候，直接使用的确不是这些量，而是需要根据这些数据解算出三轴的角度数据。比如平衡小车，需要算出 

模块的俯仰角，然后控制算法根据角度大小控制小车轮子的移动。四轴飞行器需要根据俯仰角度、滚转角度，和飞行指令来调节四个电机的转速。

 

从6轴的原始数据得到三轴的角度计算是一个比较复杂的运动学解算过程，有的童鞋可能会说，不就是三轴角速度积分不就行了吗？这就是没有实践，想当然的说法。有三点需要注意的问题：

 

1.三轴姿态的解算不能直接积分。因为三轴是有耦合的，只有在三轴角度为小角度的时候可以这么算，角度大了以后，比如60度了，这么算的误差就很大。标准的做法是用四元数的方法做姿态解算，积分的方法可以用4阶龙格-库塔法，或者4阶Gill法。详情请参考：航空航天器运动的建模——飞行动力学的理论基础 肖业伦著 北京航空航天大学出版社。

 

2.积分运算的累积误差。角速度积分运算是有累积误差的，累积误差在短时间内表现不明显，只要零点漂移处理得好了，1分钟以内的漂移都不大，但时间长了，就会有累积误差，5分钟就漂到不知道哪里去了。

 

3.角速率零点漂移。所谓零点漂移就是模块静止的时候，我们认为正常的输出应该是0，或者均值为0的数据，但是实际上6050的输出不是，可能在2°/s或者其他，而且每次都不一样，如果不校准，别说1分钟了，10秒钟误差就有20度。

 

根据上面的分析，似乎要获得角度非常困难呀。又有些聪明的朋友会想，用角速率积分这么麻烦，我不怎么算好了，条条大路通罗马，为啥非得用这个方法。6050不是能输出加速度吗？我用重力在3轴的分量的反正切值，作为滚转角和俯仰角不久行了。

 

用加速度计算的确也是一种方法，但使用加速度也有三方面的问题：

 

1.无法在动态情况下使用，使用重力的来解算姿态的前提条件是模块本身没有加速度，因此模块输出的三轴加速度值，正好是重力在模块本体坐标系下的分量，从而能够求出俯仰和滚转的姿态角度。一旦模块运动起来，这种方法就傻了，因为模块无法分辨出哪些是重力的分量，那些是模块本身的加速度引起的。目前市面上很多倾角仪就是这种思路，但问题就是没法在动态情况下使用，最简单的测试方法就是把模块水平放置桌面上，缓慢运动，发现X，Y轴的角度基本不变化，都在0度左右，一旦快速运动起来，X，Y轴就显示有很大的角度了。而实际上模块一直水平，没有变化。

 

2.精度差。6050模块的加速度本身的精度不高，就算是在静态情况下，角度测量的精度也只能到1°左右。

 

3.三轴耦合问题。利用加速度求解姿态的时候，也会有三轴耦合的问题，因为姿态表示与坐标旋转顺序有关，这样只有一种一个轴能用反正切值计算，另一个轴不能用反正切值计算。

 

那么怎么才能得到高精度不漂移的三轴角度呢？陀螺仪精度高，但时间长了会有漂移，加速度动态精度差，但没有长期漂移。能否综合利用陀螺仪和加速度计的特点，优势互补获得准确的姿态角度呢？答案是肯定的，方法就是用卡尔曼滤波做数据融合。大致的思路是将模块的姿态用四元素表示，作为系统的状态量，模块的姿态运动学方程作为滤波的状态转移方程，加速度信息作为滤波的观察量信息，然后利用卡尔曼滤波的计算方法迭代计算更新，详细的过程可以参考惯性导航方面的书籍。不过卡尔曼滤波算法比较复杂，需要用到矩阵运算等等，数学功底和编程基础要求都较高，不是初学者能够快速掌握的。而且MPU6050模块是IIC接口输出的，也给初学者带来了不少障碍与困难。

 

————————————————————

 

上一篇:Arduino学习笔记：倒计时读数器

下一篇: Arduino机器人第6课：创意风扇