看看大牛讲MPU6050

dj狂人

看看大牛讲MPU6050 [复制链接]

 

转载自：http://www.geek-workshop.com/thread-7765-1-1.html

        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
接口输出的，也给初学者带来了不少障碍与困难。

dj狂人

这是从别的论坛中看到的，觉得不错就转过来了。不懂这样是否侵权，如果有的话告知下，马上删

dj狂人

论坛里面有在DIY四轴的吗，一起讨论下

huaiqiao

总能在你这里，看到PID等等之类的，一些详细的说明。O(∩_∩)O哈哈~

dj狂人

huaiqiao 发表于 2015-6-16 16:58
总能在你这里，看到PID等等之类的，一些详细的说明。O(∩_∩)O哈哈~

哈哈  是因为最近在折腾这方面的。发现网上的资料的都好散，有详细讲的但又不到那个层次比较费理解，发现些通俗易懂的就转过来了

huaiqiao

dj狂人 发表于 2015-6-16 17:03
哈哈  是因为最近在折腾这方面的。发现网上的资料的都好散，有详细讲的但又不到那个层次比较费理解，发现 ...

呵呵，支持。

ljj3166

光有陀螺仪和加速度计，计算出来的角度也不是最可靠的
特别是z轴

dj狂人

ljj3166 发表于 2015-6-18 20:57
光有陀螺仪和加速度计，计算出来的角度也不是最可靠的
特别是z轴

这个看怎么处理，处理好就可靠。不过Z轴确实会飘，的加电子罗盘进行校正

xiongpb

MARK

天天好心情亲

dj狂人 发表于 2015-6-19 11:22
这个看怎么处理，处理好就可靠。不过Z轴确实会飘，的加电子罗盘进行校正

楼主 咋么用电子罗盘校正MPU6050的Z轴？ 这个小白有点不会啊！！可否告知一下下？？？？？？？？？
1920367503@qq.com

够了

电子罗盘校正MPU6050的Z轴？

dj狂人

天天好心情亲 发表于 2015-11-19 11:35
楼主 咋么用电子罗盘校正MPU6050的Z轴？ 这个小白有点不会啊！！可否告知一下下？？？？？？？？？

这个我还没调通，你可以百度下九轴(MPU6050+HMC5883L)数据融合

dj狂人

够了 发表于 2015-12-17 13:31
电子罗盘校正MPU6050的Z轴？

是的。MPU6050单纯的只使用陀螺仪求出的原始角速度数据的话并不适用于姿态解算，因为他的积分过程会让误差越来越大。所以他里面还有三轴加速度计用于辅助陀螺仪，但加速度计也没不适用于矫正Z轴，所以Z轴的矫正需要陀螺仪来完成。具体可百度“MPU6050+HMC5883L九轴数据融合”

gavinfree

这几天做自平衡小车，看了好几种滤波，发现就一阶互补滤波最简单，就一行，卡尔曼太复杂了，表示看不懂，但实际通过数据观察，发现其实效果相差不大（当然卡尔曼是最好的）。PID方面极客工坊精华里面有很多，大家有兴趣可以去看看

axushilong

觉得分析的很透彻

行走小样

学习了

动手动脑

mark

丿沙漏丨

有没有人今年电赛搞小车的

BDBK

无敌超超

丿沙漏丨 发表于 2017-8-5 16:51
有没有人今年电赛搞小车的

今年有小车么