[有奖问答] MPU6050 的Z轴角度计算公式

[复制链接]
17020|19
 楼主| kamp2000 发表于 2015-1-4 14:36 | 显示全部楼层 |阅读模式
DMP已经调出来了,但取一帧DMP数据花的时间较长,想自己获取原始数据来kalman滤波,现在是根据反正切得到了X轴,Y轴数据,效果还行,但Z轴总是不对,看了老外一篇帖子说不能再用反正切了,但也没讲个所以然,这里请教该如何根据原始加速度和角速度获得Z轴的转动角度呢 ?  谢谢了

icegoat 发表于 2015-1-4 14:38 | 显示全部楼层
DMP是什么?解释一下呗。
LguoFu 发表于 2015-1-5 15:16 | 显示全部楼层
icegoat 发表于 2015-1-4 14:38
DMP是什么?解释一下呗。

dmp通过使用MPU6050芯片中内置的数据解算功能直接输出四元数、欧拉角等数据
icegoat 发表于 2015-1-7 09:30 | 显示全部楼层
LguoFu 发表于 2015-1-5 15:16
dmp通过使用MPU6050芯片中内置的数据解算功能直接输出四元数、欧拉角等数据 ...

dmp是一个算法?
LguoFu 发表于 2015-1-7 13:37 | 显示全部楼层
icegoat 发表于 2015-1-7 09:30
dmp是一个算法?

一个数据处理单元
icegoat 发表于 2015-1-8 09:59 | 显示全部楼层
LguoFu 发表于 2015-1-7 13:37
一个数据处理单元

请问有源码吗?从哪里能找到?我也想参考一下。
ml3670110 发表于 2015-1-12 12:46 | 显示全部楼层
在平面的时候Yaw = tan(my/mx)。当存在Roll 和 Pitch时,只要把三维的数值分解到平面就可以。公式如下:
yh = my * cos(Roll) + mz * sin(Roll);
xh = mx*cos(Pitch) + my*sin(Roll)*sin(Pitch) - mz * cos(Roll)*sin(Pitch)
tan(Yaw)=(yh/xh)
Yaw = arctan(yh/xh)。
公式就是这样。但是MPU6050里面的DMP没有磁力计的修正,YAW是不能用的,会很漂
gy810986741 发表于 2015-1-12 13:04 | 显示全部楼层
先对mpu6050的陀螺仪进行校准,得到零偏,然后直接积分就可以得到角度了,一直这么用,感觉很稳
star33445 发表于 2015-1-17 08:27 | 显示全部楼层
DMP 200HZ的刷新频率并不低,至于Z轴确实是一塌糊涂,一秒飘一度。可不可以从DMP里读出四元数,归一化之后用常见的融合把磁力计数据补偿进去,我单独用过DMP是放弃了航偏的,单独用AHRS融合过磁力计,因为在室内用磁力计抖动的厉害也放弃使用了。
can_all 发表于 2015-2-9 09:36 | 显示全部楼层
YAW += GYROZ*DT; 积分
摩天轮1111 发表于 2015-8-25 20:13 | 显示全部楼层
star33445 发表于 2015-1-17 08:27
DMP 200HZ的刷新频率并不低,至于Z轴确实是一塌糊涂,一秒飘一度。可不可以从DMP里读出四元数,归一化之后 ...

1秒飘一度,是你dmp没搞明白,我30分钟才飘10度不到,怎么解,呵呵,,
18796007675 发表于 2015-10-12 08:56 | 显示全部楼层
你好可以把程序共享一下吗?最近这一块卡在这里了
cnb12345 发表于 2015-10-12 16:36 | 显示全部楼层
以为自己懂才进来的,结果还是帮不上忙
18796007675 发表于 2015-10-18 13:41 来自手机 | 显示全部楼层
摩天轮1111 发表于 2015-8-25 20:13
1秒飘一度,是你dmp没搞明白,我30分钟才飘10度不到,怎么解,呵呵,,

你好你程序可以共享一下吗?598754908@qq.com
摩天轮1111 发表于 2015-10-18 18:26 | 显示全部楼层
不好意思,因为这个程序是要做商业用途的,不方便公开的,但是我能肯定的告诉你dmp融合数据有这个能力,而且它还有8秒还是几秒记不得了,如果不动,传感器会自己校准零飘的能力的
lijianfeng-11 发表于 2015-10-28 22:44 | 显示全部楼层
想问下楼主主控芯片是什么
天天好心情亲 发表于 2015-11-22 12:34 | 显示全部楼层
gy810986741 发表于 2015-1-12 13:04
先对mpu6050的陀螺仪进行校准,得到零偏,然后直接积分就可以得到角度了,一直这么用,感觉很稳 ...

zai   ? 最近在玩MPU6050    校准MPU6050的z轴 的问题 不太懂, 可以指导一下吗 ?qq1920367503
gy810986741 发表于 2015-11-25 16:22 | 显示全部楼层
天天好心情亲 发表于 2015-11-22 12:34
zai   ? 最近在玩MPU6050    校准MPU6050的z轴 的问题 不太懂, 可以指导一下吗 ?qq1920367503 ...

这都过去多久了。。。
io569417668 发表于 2016-5-23 20:55 | 显示全部楼层
楼主你好,我用四元素借偏航角,可是另外两个角度都正确,但是偏航角和真实值偏差有点大,楼主有没有解决偏航角
sum123456 发表于 2018-4-12 15:39 | 显示全部楼层

以为自己懂才进来的,结果还是帮不上忙
您需要登录后才可以回帖 登录 | 注册

本版积分规则

5

主题

19

帖子

0

粉丝
快速回复 在线客服 返回列表 返回顶部