你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

【Nucleo】F072RB DMP移植 ----六轴MPU6050 欧拉角  

[复制链接]
xyc2690 发布时间:2015-1-29 16:52
本帖最后由 xyc2690 于 2015-1-29 17:09 编辑 7 r  R: m  {3 H' N, R7 c

" e7 ]3 k: V, R8 X% ] 1422516698921.jpg
; l8 q( E6 q% p" g9 d, o  p( A' z3 a8 s9 q2 e1 u9 m
功能:DMP读取MPU6050四元数,转换成欧拉角。
3 [( a! }0 G% k* L8 x: \9 @9 E) P- Z9 |
引脚:5 R1 A7 {/ M. S7 y7 S: L6 d& P

2 W: K2 y4 g$ A  l2 _8 D/ r% a/ w) H        MPU6050:: H3 \  A; m: O
                SCL-->PB8
- u6 |% Z6 W4 c7 c- u& U% P! H0 T# g                SDA-->PB9
1 y% S/ g& Q6 V. v% c( _# Z4 |                ADO-->GND4 g4 }$ g8 v$ _  p2 c4 |7 Z

6 j* [4 @9 _& E& x        USART1: Tx PA9
- }) ~3 w3 Q  W) n3 _) j1 |
4 |# [% t' h7 v' y& r  F官方提供的DMP移植到Nucleo F072RB; X+ S9 b! @) c0 @+ _
+ n/ H& B5 ?$ y  z7 _8 w( C3 Z
欧拉角:Roll Pitch Yaw  N+ F& x  |  j! [

* a% E8 ~- p4 n% Y' Y4 G2s左右初始化建立时间。1 D( X; d5 ]6 Q% p! t0 d# m8 [9 O
0 R3 |- {) s3 C) z; s; q/ U' D& S
Roll和Pitch比较稳定。静止时数据没有漂移。
1 @  s  e; u& l: X  ~
: Q) X( D0 s) E* L0 Q2 DYaw会漂移,MPU6050,6轴无法校正。需要用磁力传感器。
- v0 t, @% q$ G. _+ l7 `9 u
( O3 c3 A; i) v% k2 o9 I QQ截图20150129170500.jpg % w- J& i! G2 d: X& u2 Y# u1 |
之前直接去读原始数据,读出三轴加速度和三轴角加速度,但是数据融合一直不好,要做平衡车的话用到俯仰角和一轴角加速度就行了,后来才发现用DMP处理好的数据更方便。网上有许多移植到STM32F103的,但是手头没有103的板子,加上准备学习用新的HAL库,于是折腾了2天移植到活动送的NucleoF072上,IIC比较关键,认真的做好时序之后会很省心。最后读出的四元数是Q30的,要除一下。
0 S* a4 `  `+ M4 I0 j$ {) J* |% Q QQ截图20150129145351.jpg
( u! H* v6 l& F4 V6 X, MIIC驱动那边需要注意一下,6050官方库里的函数返回值,成功返回0,异常返回-1,-2 等。  一般写1表示成功,0表示失败。大家移植的时候注意一下。9 j# c: `0 W! N8 N8 ^* T) X
存在FIFO溢出的问题,具体在dmp_read_fifo()函数里的mpu_read_fifo_stream()的最后
+ p" |+ T( @- C2 Q6 z1 X7 z$ n: _
  1. if (tmp[0] & BIT_FIFO_OVERFLOW)
    , b+ j6 E6 Z* s: r" x5 \% @8 w$ A
  2. {
    % t- e' B" D4 Y5 x3 ~/ g
  3.   mpu_reset_fifo();7 b% l  ?$ R( j" ]
  4.   return -2;
    ) z( p- T, G& B. u$ W
  5. }
复制代码

3 k! W# H- _3 l' h- @. s" C暂时把它注释掉了,有人知道如何解决吗?
0 }; {/ j/ y8 t' F& j4 P) t% }$ q) a( f
参加活动有NucleoF072rb的板子并且有MPU6050的朋友可以试一下; B6 ]; _3 G2 e  W1 [
程序:
7 M6 C, H3 L0 Z2 \4 B/ p0 m Nocleo_soft_i2c_test1 - 移植失败1失败2失败3成功4.zip (4.07 MB, 下载次数: 2995)
赞 收藏 3 评论38 发布时间:2015-1-29 16:52

举报

38个回答
党国特派员 回答时间:2015-1-31 14:04:03
学习了。 nothing.png nothing.png nothing.png nothing.png nothing.png nothing.png nothing.png nothing.png nothing.png nothing.png
) U4 y' F) ^6 D" T, \
xyc2690 回答时间:2015-1-30 17:23:22
逍遥李 发表于 2015-1-30 07:49
+ N! y5 Y% i1 i8 f' P% `3 m* C可是我手里只有那种TT电机,楼主选的是什么电机?
+ p% Q/ _3 J2 r" |
也是用的减速电机,# K! v5 k, g  h) N+ O; c
电机的话看参数:电流/扭矩常数、电压/转速常数
# F- C' Q  ]0 {# m! _: ~选力矩大一些的电机就行了。
逍遥李 回答时间:2015-1-31 14:18:28
xyc2690 发表于 2015-1-30 17:23
' E  w: a2 x" d8 Q也是用的减速电机,6 w1 U( W* c  \5 X( b' W6 i
电机的话看参数:电流/扭矩常数、电压/转速常数
" f* @, C& y- q4 y选力矩大一些的电机就行了。 ...

( A# j, `5 r) z好的,多谢,回头做了还需要楼主多多指点!
沐紫 回答时间:2015-1-29 17:53:38
谢谢!
逍遥李 回答时间:2015-1-29 18:40:44
果然有人搞MPU6050二轮车了!顶你啊楼主,我也想用nucleo弄一个二轮车,期待下次活动!
qianfan 回答时间:2015-1-29 20:07:46
话说那一坨焊锡挺值钱的。。。
万里-363223 回答时间:2015-1-29 21:31:16
好东西,谢谢分享.......
lkl0305 回答时间:2015-1-29 21:34:44
楼主辛苦
zhangdaijin 回答时间:2015-1-29 21:57:29
moyanming2013 回答时间:2015-1-29 22:31:48
很高大。。。。。。
xyc2690 回答时间:2015-1-29 23:03:31
逍遥李 发表于 2015-1-29 18:40  w9 a2 z5 C6 E+ Z7 s
果然有人搞MPU6050二轮车了!顶你啊楼主,我也想用nucleo弄一个二轮车,期待下次活动! ...

, K, Q/ Z0 A5 g  `4 A& ~0 V7 ?电机好好选哈~
xyc2690 回答时间:2015-1-29 23:04:35
沐紫 发表于 2015-1-29 17:534 w6 ~) N6 _) c9 k
谢谢!

4 K. z$ r+ u  a3 T4 y" k多谢版主的开发板
MouseCat 回答时间:2015-1-29 23:17:52
MARK围观学习了
小蚂蚁快溜跑 回答时间:2015-1-29 23:47:23
学习。。电脑y400.。
逍遥李 回答时间:2015-1-30 07:49:19
xyc2690 发表于 2015-1-29 23:03
$ N! @# a: ]! O! Y4 m) F2 d& M8 y电机好好选哈~
% Z) Z3 W' o# z) |" c3 V( d# W4 ~
可是我手里只有那种TT电机,楼主选的是什么电机?
埃斯提爱慕 回答时间:2015-1-30 11:50:50
提示: 作者被禁止或删除 内容自动屏蔽
wu1169668869 回答时间:2015-1-30 12:57:36
QianFan 发表于 2015-1-29 20:07* y3 `/ @5 \/ x% N6 v! X
话说那一坨焊锡挺值钱的。。。

2 [$ r% u/ X" l好诡异的关注点哈哈
123下一页

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版