关于IMU

用IMU估计轨迹是可行的，但是对于6050来说非常不好，用个好点的IMU吧。看看人家做的：
https://www.youtube.com/watch?v=6ijArKE8vKU， 要自己做出这个效果也是可以的。

不要用欧拉角，欧拉角解算起来很蛋疼，用DCM或者是quaternion。
DMP就是鬼扯，非常不准。

理论上说，只要能实时获得运动的三轴加速度和三轴角速度，通过坐标变换和积分就可以获得实时的速度和相对于初始点的距离，这也是惯性导航的基本原理。

但是对于MPU6050之类的MEMS器件，其精度和漂移都很严重，即使是做完温度等因素的补偿，两轮积分下来误差也是会随时间增加迅速增大，所以单纯依靠MEMS器件推算运动路径当前阶段不可行。