终于不用纠结姿态融合的问题了，MPU6050直接内置融合引擎

lotsbiss · 发表于 2013-4-10 23:05:19

官方的运动库，必须通过这个才能启用MPU6050的DMP引擎(数据手册里完全不提这个东西，必须在官网注册登录后才有·····)
里面的代码是基于msp430的，不过很容易就能移植到stm32上面。
编译一下，把报错的地方改掉就OK。

唯一需要的就是得提供i2c读写接口，然后在
#define i2c_write(a, b, c, d) !I2C_BufferWrite(d, c, b, a)
这里替换

剩下的就是照着范例文件依次调用函数
主要是这几个

mpu_init();
mpu_set_sensors(INV_XYZ_GYRO | INV_XYZ_ACCEL);
mpu_configure_fifo(INV_XYZ_GYRO | INV_XYZ_ACCEL);mpu_set_sample_rate(DEFAULT_MPU_HZ);
dmp_load_motion_driver_firmware();
dmp_set_orientation(inv_orientation_matrix_to_scalar(gyro_orientation));
dmp_enable_feature(hal.dmp_features);
dmp_set_fifo_rate(DEFAULT_MPU_HZ);
run_self_test();
mpu_set_dmp_state(1);

复制代码

其中dmp_load_motion_driver_firmware()这个很重要，失败的话就没法开启DMP
run_self_test();是自检，用来消除漂移的

初始化完成后在死循环里调用dmp_read_fifo(gyro, accel, quat, &sensor_timestamp, &sensors, &more);来读取FIFO
(sensors & INV_WXYZ_QUAT)为真就说明读到四元数，默认是long，得转换成float后除以 1073741824.0f，然后就能使用了，顺序是wxyz

http://player.youku.com/player.php/sid/XNTQwOTczNDE2/v.swf

liuhengpeng123 · 发表于 2013-4-10 23:18:47

这么好，上位机软件去那里要的？

dxf5200 · 发表于 2013-4-10 23:24:25

这个资料非常棒。

qwe2231695 · 发表于 2013-4-10 23:45:17

靠，我说没有任何资料呢呢，终于等到mpu6050的内部隐藏大招了！！

lxl_lw · 发表于 2013-4-11 00:08:07

获取的是什么数据？

wangjt1988 · 发表于 2013-4-11 00:19:10

楼主太给力了! 还有一个资料，gitlab上有大神上传过一个基于arduino的dmp，测试过，也可以用在stm32上
顶楼主!!!

lxl_lw · 发表于 2013-4-11 00:49:49

wangjt1988 发表于 2013-4-11 00:19
楼主太给力了! 还有一个资料，gitlab上有大神上传过一个基于arduino的dmp，测试过，也可以用在stm32上
顶 ...

有学长说普通的操作方式读取的6050数据是经过“处理”的，不知道“处理了什么？”

wangjt1988 · 发表于 2013-4-11 08:03:06

lxl_lw 发表于 2013-4-11 00:49
有学长说普通的操作方式读取的6050数据是经过“处理”的，不知道“处理了什么？” ...

读传感器数据就经过了ad处理，还有可能经过了滤波处理看你怎么设置了读dmp数据就更经过处理了……

cctsao1008 · 发表于 2013-4-11 10:36:28

that will be great.

皮爱了西 · 发表于 2013-4-11 11:12:32

回去试试看。

yue621 · 发表于 2013-4-11 11:17:19

牛叉啊！隐藏了这么好的东东~！

zhang1028kun · 发表于 2013-4-11 12:55:01

这个资料真的不错啊

蓝海de梦 · 发表于 2013-4-11 13:43:41

上位机哪找的？

lotsbiss · 发表于 2013-4-11 15:36:10

wangjt1988 发表于 2013-4-11 00:19
楼主太给力了! 还有一个资料，gitlab上有大神上传过一个基于arduino的dmp，测试过，也可以用在stm32上
顶 ...

那个资料我看过，应该也是某个版本的官方库移植的

Name_006 · 发表于 2013-4-11 16:02:57

哇塞果然不错研究研究

seeyou2013 · 发表于 2013-4-11 16:11:13

学习啊，，

sunliezhi · 发表于 2013-4-11 17:40:52

收藏!!!!

lotsbiss · 发表于 2013-4-12 14:22:23

Name_006 发表于 2013-4-11 16:02
哇塞果然不错研究研究 ...

没短消息权限，我就在这说吧
移植时注意MPU6050的i2c的地址(st.hw->addr)，有0x68和0x69这2种，如果是网上的某个stm32模拟i2c接口，地址还得左移一位，就是0xD0和0xD2

Name_006 · 发表于 2013-4-12 14:35:13

lotsbiss 发表于 2013-4-12 14:22
没短消息权限，我就在这说吧
移植时注意MPU6050的i2c的地址(st.hw->addr)，有0x68和0x69这2种，如果是网 ...

恩这都没问题前面的初始化都完成了读写前面的业没什么错误基本驱动都是用了好久的但就是写入memory 的那块我试了 1字节1字节写能写进去读出来也对而且其他也return 0
但是最后 fifo没数据就是16字节 16字节写写入的跟读出的不一致导致校验那一步return 2 ，，，。。。。。

lotsbiss · 发表于 2013-4-12 14:48:15

Name_006 发表于 2013-4-12 14:35
恩这都没问题前面的初始化都完成了读写前面的业没什么错误基本驱动都是用了好久的但就是写 ...

想起来了，struct gyro_reg_s 里得删掉
unsigned char accel_cfg2;
unsigned char lp_accel_odr;
unsigned char accel_intel;
否则后面赋值时地址可能会错位

sedulity11 · 发表于 2013-4-12 18:40:27

好资料，研究下

chenjiawei7 · 发表于 2013-4-13 22:05:59

怎么用？用的什么编译器？

Elec_Ramble · 发表于 2013-4-13 22:48:37

Mark
来自：amoBBS 阿莫电子论坛 Windows Phone 7 客户端

daming326 · 发表于 2013-4-13 23:59:13

太深奥，不懂

kexiao · 发表于 2013-4-14 15:06:07

这个给力啊

炎阳 · 发表于 2013-4-15 10:57:46

终于啊。天上掉肉饽饽了。楼主太给力。顶

jiangjian1219 · 发表于 2013-4-15 15:46:40

楼主上位机也发一个.

残忆视觉 · 发表于 2013-4-18 12:20:18

不懂，也得顶一个

七弦桐 · 发表于 2013-4-18 16:11:59

应该打开哪个文件啊怎么用~

sailing8 · 发表于 2013-4-18 21:52:28

好资料，研究下，貌似下不了，郁闷。。。

sailing8 · 发表于 2013-4-18 22:00:55

可以下了，是服务器不很稳定，真的是好资料，值得研究，非常感谢楼主分享！

jslx · 发表于 2013-4-19 16:11:09

楼主这玩意用什么软件打开啊？加压后不知道怎么办了

xukkkkkk · 发表于 2013-4-19 16:36:33

楼主搞到什么文档说明没有，一个功能也搞的这么神秘，inv的说明书的确不详细

lotsbiss · 发表于 2013-4-19 20:12:05

xukkkkkk 发表于 2013-4-19 16:36
楼主搞到什么文档说明没有，一个功能也搞的这么神秘，inv的说明书的确不详细 ...

文档我就这2个

tusson · 发表于 2013-4-19 20:27:42

先顶一下

cai_mouse · 发表于 2013-4-19 23:22:34

谢谢分享。

firewise · 发表于 2013-4-20 13:54:49

不错研究研究

canopen · 发表于 2013-4-20 14:40:17

还带隐藏技能的、、、、、、、、、、、

zouyf12 · 发表于 2013-4-20 22:20:19

MAKE收藏

shang445751741 · 发表于 2013-4-21 00:46:08

mark啦楼主好人啊

kuailesyj · 发表于 2013-4-21 05:58:51

请问这一部分代码怎么处理的，为什么总是error：expected an expression

Mrdingding · 发表于 2013-4-21 16:25:04

这里帮我解决了太多问题，感谢阿莫论坛

Gost · 发表于 2013-4-21 20:24:28

上位机亮爆了，资料弄来看看先

提线木偶 · 发表于 2013-4-21 20:57:32

学习了

rantingting · 发表于 2013-4-21 21:28:15

最酷的是上位机啊，还请LZ大侠分享啊，不然就是有数据也不能搞这么好啊

wscjun · 发表于 2013-4-22 12:51:03

谢谢分享

doudoumf · 发表于 2013-4-23 09:51:01

wangjt1988 发表于 2013-4-11 00:19
楼主太给力了! 还有一个资料，gitlab上有大神上传过一个基于arduino的dmp，测试过，也可以用在stm32上
顶 ...

你有那个移植STM32的程序么，可以分享下啊！

doudoumf · 发表于 2013-4-23 09:54:16

Name_006 发表于 2013-4-12 14:35
恩这都没问题前面的初始化都完成了读写前面的业没什么错误基本驱动都是用了好久的但就是写 ...

我也是写入之后，也不能够从FIFO中读出数据，请问你是怎么解决的，求帮助

whyjld · 发表于 2013-4-23 10:14:11

学习，感谢楼主

Name_006 · 发表于 2013-4-23 10:22:34

doudoumf 发表于 2013-4-23 09:54
我也是写入之后，也不能够从FIFO中读出数据，请问你是怎么解决的，求帮助 ...

我还没弄出来主要是写入 memory 那部分数据写入不成功驱动是没问题的不知道怎么写不进去写进去跟读出来的数据不一样

孤独飞行 · 发表于 2013-4-23 11:59:27

想移植到STM8上，不知道行不行~

sz_works · 发表于 2013-4-23 14:06:16

good good

doudoumf · 发表于 2013-4-23 15:04:13

Name_006 发表于 2013-4-23 10:22
我还没弄出来主要是写入 memory 那部分数据写入不成功驱动是没问题的不知道怎么写不进去写进去 ...

我移植到LPC2131，写进去了，读出来也对，就是读不出FIFO,╮(╯▽╰)╭

yiyamala · 发表于 2013-4-23 17:01:41

怎么移植到51上啊

甲方乙方 · 发表于 2013-4-24 09:34:00

到底什么是融合呀

ZMHCISS · 发表于 2013-4-24 09:59:55

很好，谢谢

rifjft · 发表于 2013-4-24 11:05:42

好资料，顶起

甲方乙方 · 发表于 2013-4-24 16:03:42

好好研究下

keysmith · 发表于 2013-4-24 21:58:44

自己就带融合算法？？？研究一下看看！

qwe2231695 · 发表于 2013-4-25 01:05:04

用iic写入DMP固件这个部分真蛋疼。~有大侠用stm32成功了吗。 ps：这个历程写的真复杂。各种宏定义

Mxj · 发表于 2013-4-25 10:19:16

Name_006 发表于 2013-4-23 10:22
我还没弄出来主要是写入 memory 那部分数据写入不成功驱动是没问题的不知道怎么写不进去写进去 ...

我也是FIFO没有数据，求大神指点呀！

zhanghua315 · 发表于 2013-4-25 10:58:37

MARK 不错

落叶随风 · 发表于 2013-4-25 12:26:46

这个资料实在是太棒了，谢谢楼主

jiangjian1219 · 发表于 2013-4-25 14:53:48

qwe2231695 发表于 2013-4-25 01:05
用iic写入DMP固件这个部分真蛋疼。~有大侠用stm32成功了吗。 ps：这个历程写的真复杂。各种宏定义 ...

兄弟,我也遇到了 ,正在痛苦中..

zhousf85 · 发表于 2013-4-25 15:00:03

真的很难看的懂，跟别说移植了。

yh1036164041 · 发表于 2013-4-27 10:45:22

楼主，你那个程序适用于stc89c52吗？

yzaka · 发表于 2013-4-27 15:22:13

i love you

wickedseason · 发表于 2013-4-28 19:21:46

LZ能把上位机分享一下么- -

Andre.Gorz · 发表于 2013-4-29 06:49:53

好东西当然要收藏着嘿嘿。

可与愉快谔谔 · 发表于 2013-4-29 08:46:34

姿态融合，有点深奥

凌海滨 · 发表于 2013-4-29 09:19:57

顶，上位机不错

~just_yy · 发表于 2013-5-6 21:58:11

为什么这么好的功能不写进datasheet里面呢？

一棵葱 · 发表于 2013-5-6 22:23:25

楼主好人，我来看看！！

cai_mouse · 发表于 2013-5-6 23:03:34

请问这个软件用到IRQpin脚吗

cai_mouse · 发表于 2013-5-6 23:04:09

好像跟github上的DMP很像的

windless · 发表于 2013-5-7 17:55:27

楼主能把移植的stm32文件发布一下学习学习么？

ljc2012 · 发表于 2013-5-7 22:43:41

mark

ljc2012 · 发表于 2013-5-7 23:35:04

heh 如果本来就是用的MSp430 那不很爽啊。。。。

不过习惯了用IAR，这CCS软件编写的，还是压力山大，不过谢谢了，先去研究去了

CrystalShell · 发表于 2013-5-8 09:21:32

wangjt1988 发表于 2013-4-11 00:19
楼主太给力了! 还有一个资料，gitlab上有大神上传过一个基于arduino的dmp，测试过，也可以用在stm32上
顶 ...

gitlab上有大神上传过一个基于arduino的dmp…… 大神，求网址，我玩的是Arduino

chenjy · 发表于 2013-5-8 13:16:56

经过dmp后的数据，我们得到了哪些值啊是不是和四元数算法最后得出的值是一样啊？？？？

残忆视觉 · 发表于 2013-5-9 16:44:52

楼主，能不能移植到飞思卡尔单片机上啊，XSDG128，官网地址没查到啊，给发个链接吧，看看去

xixiangfeng · 发表于 2013-5-12 23:58:57

非常好的资料，谢谢ＬＺ。很难找到官方的motion app。移植了来自于Arduino中的DMP，但是有问题，而且移植起来累死了。

问乐寻音 · 发表于 2013-5-13 09:09:22

好东西啊，果断顶！！！

mcu1234mcu · 发表于 2013-5-15 11:07:03

帅呆了

mcu1234mcu · 发表于 2013-5-15 16:21:37

kuailesyj 发表于 2013-4-21 05:58
请问这一部分代码怎么处理的，为什么总是error：expected an expression

我的也是这个问题，不知道什么原因。

mcu1234mcu · 发表于 2013-5-16 09:34:04

lotsbiss 发表于 2013-4-19 20:12
文档我就这2个

请问这个函数是什么意思？

reg_int_cb(void (*cb)(void), unsigned char port, unsigned char pin)

王者归来 · 发表于 2013-5-16 10:02:13

先下载来看看，感谢楼主咯

mcu1234mcu · 发表于 2013-5-16 10:18:37

本帖最后由 mcu1234mcu 于 2013-5-16 15:36 编辑

已解决

mcu1234mcu · 发表于 2013-5-16 15:35:48

版主你们用的开发环境是MDK还是IAR，哪个版本的？我移植到IAR 中这个函数int mpu_init(struct int_param_s *int_param)会出现问题，还有就是Error while running C/C++ Compiler 这个问题。
移植到MDK中
static struct gyro_state_s st = {
&reg,//.reg = &reg,
&hw,//.hw = &hw,
&test//.test = &test
};
这个会出现问题，请问楼主应该怎么修改，谢谢了。

kai1011 · 发表于 2013-5-16 17:39:59

正需要这个！谢谢分享

kai1011 · 发表于 2013-5-16 23:12:28

CrystalShell 发表于 2013-5-8 09:21
gitlab上有大神上传过一个基于arduino的dmp…… 大神，求网址，我玩的是Arduino ...

应该是这个吧
https://github.com/jrowberg/i2cdevlib/tree/master/Arduino/MPU6050

mcu1234mcu · 发表于 2013-5-17 10:57:36

kuailesyj 发表于 2013-4-21 05:58
请问这一部分代码怎么处理的，为什么总是error：expected an expression

直接改为
0x75,//.who_am_i    = 0x75,
0x19,//.rate_div    = 0x19,
0x1A,//.lpf          = 0x1A,
这个形式就可以了，gun c和标准C差别比较大。

mcu1234mcu · 发表于 2013-5-17 11:00:08

mcu1234mcu 发表于 2013-5-15 16:21
我的也是这个问题，不知道什么原因。

已解决

mcu1234mcu · 发表于 2013-5-17 11:00:31

mcu1234mcu 发表于 2013-5-16 15:35
版主你们用的开发环境是MDK还是IAR，哪个版本的？我移植到IAR 中这个函数int mpu_init(struct int_param_s ...

已解决

pan020503 · 发表于 2013-5-17 15:43:45

mcu1234mcu 发表于 2013-5-17 11:00
已解决

亲，你是怎么解决这个问题的？可不可以发程序上来看看？万分感谢

yssdsz · 发表于 2013-5-18 20:44:43

mark~~~~

MCU_fans · 发表于 2013-5-19 03:36:09

天哪！！！！

gadwgdsk77gg · 发表于 2013-5-19 16:36:47

Name_006 发表于 2013-4-23 10:22
我还没弄出来主要是写入 memory 那部分数据写入不成功驱动是没问题的不知道怎么写不进去写进去 ...

我的也是，程序初始化到
result =
   dmp_load_motion_driver_firmware();
就出错了。就如看，把错误信息发回来，发现是写到mem的内容和读出来的不一样。
if (mpu_write_mem(ii, this_write, (unsigned char*)&firmware[ii]))
   return -2;
if (mpu_read_mem(ii, this_write, cur))
   return -3;

这里一个写一个读，但是执行 if (memcmp(firmware+ii, cur, this_write))时就发现写入和读出不一样
写入第一个16Bytes和dmp_memory定义一致
00 10 00 00 70 00 00 00 00 24 00 00 00 02 00 03 00 00
但是读出的是
00 10 00 00 00 00 00 00 68 00 00 00 00 00 00 00 00 00
已经调了两天了，还是解决不了问题。
用的i2c是内部的，以前不用DMP的时候都没有问题，用来做别的大项目也没有发现问题。我想应该不会i2c的问题。

gadwgdsk77gg · 发表于 2013-5-19 16:39:17

楼主大哥，可否帮忙解决一下问题
程序初始化到
result =
      dmp_load_motion_driver_firmware();
就出错了（返回-2）。进去看，把错误信息发回来，发现是写到mem的内容和读出来的不一样。
if (mpu_write_mem(ii, this_write, (unsigned char*)&firmware[ii]))
   return -2; //我改的，上面的-2是原本的
if (mpu_read_mem(ii, this_write, cur))
   return -3;//我改的

这里一个写一个读，但是执行 if (memcmp(firmware+ii, cur, this_write))时就发现写入和读出不一样
写入第一个16Bytes和dmp_memory定义一致
00 10 00 00 70 00 00 00 00 24 00 00 00 02 00 03 00 00
但是读出的是
00 10 00 00 00 00 00 00 68 00 00 00 00 00 00 00 00 00
已经调了两天了，还是解决不了问题。
用的i2c是内部的，以前不用DMP的时候都没有问题，用来做别的大项目也没有发现问题。我想应该不会i2c的问题。

lotsbiss · 发表于 2013-5-19 16:47:58

gadwgdsk77gg 发表于 2013-5-19 16:39
楼主大哥，可否帮忙解决一下问题
程序初始化到
result =

这个真不清楚···
我用的时候没有在这卡过
都是直接就过去了··

终于不用纠结姿态融合的问题了，MPU6050直接内置融合引擎

本帖子中包含更多资源

阿莫论坛20周年了！感谢大家的支持与爱护！！

本帖子中包含更多资源

本帖子中包含更多资源