一、 MPU6050简介
4 D7 [2 ]% H- Q7 m5 { y4 O0 eMPU6050集成了3轴加速度和3轴陀螺仪,是一款不错的传感器模块,可以用在很多方面,比如:四轴飞控、空中鼠标、两轮平衡车、GPS定位方面、游戏机、3D遥控器、平板设备等等,此模块给我们提供了强大的数据供应,由于将加速度和陀螺仪集成到了一起,免去了组合这两个模块时之间的轴差问题,减少了包装问题,这两年很火,成了DIY制作者的最爱。
( X; l1 @2 u0 _* @ ^( ?2 C3 \; G) P/ I
二、 细节问题, q+ Y' n( Z5 u" q
在淘宝上买MPU6050时,要注意一下几点:9 n2 l; {7 I5 Z3 a0 J
" _' z& l, h2 I8 s4 ~% l( Q* E1.查看卖家给出的介绍信息,是否刻意夸大,结合自己所学的知识进行判断。比如:当时在某个论坛上看到某位大神将的,tb上说他们的模块采用高性能的微处理器和先进的动力学解算与卡尔曼动态滤波算法,能够快速求解出模块当前的实时运动姿态。细心的你就会发现它的这种处理器根本就不能提供这种需求,也就是会所计算不出来。2.不要让模块受到碰撞,否则会影响他的性能。# e& Z8 }' U( ]' i0 |
% f/ I* b" N' O' J三、相关技术4 k" E1 o' ^: g$ G
MPU6050数据是用IIC进行读取的,So必须学会IIC。类似于USB协议,不过和USB比起来可以说是小巫见大巫。
0 l3 f/ u6 M2 @' }* E+ s, b' ^. I7 _- I5 Q5 d1 G) v
1.IIC技术概述
& ^! S5 x9 S _, l/ ZIIC 即Inter-Integrated Circuit(集成电路总线),这种总线类型是 由飞利浦半导体公司在八十年代初设计出来的两线式串行总线
1 S% C- _* s4 h) B2 J! `特点:接口线少、器件封装形式小、通信速率较高2 H) F; _+ V& h+ x8 \$ E
IIC总线只有两根双向信号线,如下图所示: X- r' L9 _$ M0 h2 ^3 c) h
$ }6 u7 h8 R9 e3 ?" O* U
- ?1 u; f y3 g- `1 S9 S1 D
9 b6 M; V9 V8 x$ t. ]7 j$ M
2.IIC数据传输
' l+ I4 _, s1 f, P' H$ J数据有效位的定义:2 x1 \. I6 t0 y4 J" M2 p/ g: o
IIC总线在进行数据传输时,时钟信号为高电平期间,数据线上的数据必须保持稳定,只有在时钟线上的信号为低电平期间,数据线的高电平或低电平状态才允许变化2 U# N/ c' H; }* T
起始和停止条件:( h( v/ S" l6 W( U7 p
当SCL线是高电平时,SDA线从高电平向低电平切换,这个情况视为起始条件。
; X7 {: E X" s' H1 T当SCL线是高电平时,SDA线有低电平向高电平切换,表示停止条件
% P1 y k! B" d+ F. T' l: \数据传输格式:) y3 n' W# r& Y
7 X4 b4 A! b5 b* Q+ e( S; [
. i3 L8 W/ t; |, E
+ j; ^; V U3 E2 F
3.IIC总线寻址' t! s1 j. ?: o4 S+ Y G
IIC总线规定:从机地址有第一个字节的7位组成
- C5 o% Q# L, q) w) [(想要插入表格,可是在这里不会用了,直接从world中截张图算了)2 X* z" E" ~6 s. F- ~
8 E1 O5 [: G; k0 Z1 c3 M& {
& Q- O: b" u( c% }" |' Q4 h$ V) `2 X
4.IIC总线编号
9 a/ `: \/ k1 \% C从机的地址有固定部分和可编程部分组成。在一个系统中可能希望接入多个相同的从机,从机地址中科编程部分决定了可接入总线该类期间的最大数目
( t* |* K- L6 b6 Y& `2 O) m
$ n6 e9 L( Q# _" ?' Q0 y; F例如:一个从机的7位寻址中有4为是固定的,3位是可编程的,那个这时仅能寻址8个同类期间。. @$ L9 ^4 ]( f
: V8 _8 Q; B. z1 f0 |) T
5.STM32F103中的IIC
* K! |- a# n. j( L7 I6 v这里主要看下载STM32中,IIC是怎么个分布:9 F" U" C9 x8 u# \' [; o7 I
" A+ I% |6 X' y b& l+ ~
! Y8 [& S& r# `$ g* h6 Z- u
( X: c6 g9 q" u四、操作步骤# n, }; j& R" q5 K' _7 G2 m
1.熟悉MPU6050管脚% Z& x! ~1 F' g" _
3 U& Q( ^! M. ^7 g0 U6 z
6 _" k* F3 S8 C. E9 Z1 p2 n( K1 q* `
上图是我自己的模块,由于连上了线,管脚不是很清楚,可以看着一张,管脚和清楚的。. ^3 P5 N0 R% ?4 E, K
: N$ G! l+ L; { u L4 y$ s) g
! s9 b) Y8 i/ M* ?& G. ^
. n2 C/ Q* v. x
2.管脚功能介绍
* ]0 ~9 f% ]) S9 m" }3 u1 `& x# U3 e2 {& Y$ G2 K
k0 ?9 _6 m) v, J6 P! j
% y4 N1 U( ?/ O+ F
这里已经很详细的介绍了各个管脚的功能,在心里就有个大概了解,在后面编写代码中就会明白好多,更多细节可以查看手册的!) |4 {+ G4 E. G1 b5 D. ~, b! L- _
; J \3 D+ c7 ^ P+ ^4 \* x1 z
/ v4 K# Q4 s- K) m3 e
五、实现代码0 c \! {6 E5 b+ m" G
当时开始做这个东西的时候参考了原子、野火的各个例子,再次感谢你们。
( B+ u* s5 ~& n( u! N! E5 C8 ~ g0 c1 u
代码块
& \' M: Z1 }7 Z4 m/ oMPU初始化:
3 k# N0 u4 @: y. S. T. y6 Z/ k
3 c, Q0 U* ^3 q0 P, l- void MPU_Init()
* d6 |7 V' v2 I; i - {
0 F7 D# F# i8 g' ~2 K/ a+ A# Q7 a) u - ANBT_I2C_Configuration(); //IIC初始化
) q7 t6 g; t5 v - delay_ms(30);
5 p' |# [) F6 Y& @0 g - AnBT_DMP_MPU6050_Init(); //MPU6050 的DMP初始化) J, R; w" k% O( d6 a
- }
复制代码
' v( j; C6 @. F% P下边是读取陀螺仪的数据函数:9 c' e$ u2 N! {/ h5 [/ z
. n1 X/ \" \/ l8 b& c! G* f- void Read_Gyro_data(short *rxbuf) ?1 K% n, ^) S8 _8 V* ^6 Z
- {: J7 j+ x& C8 `% F9 {3 i, I
- unsigned long sensor_timestamp;
+ ~8 Q" d- K- T8 B; W2 v7 ` - unsigned char i = 0;- i8 q& ~6 n1 }! S/ Z2 u
- short gyro[3], accel[3], sensors;//陀螺仪存放数组,加速度存放数组,返回状态量; q; n) G* @% E0 l9 V
- unsigned char more;
( q7 N& {' l' {4 R# \ - long quat[4]; //四元数存放数组
0 T3 }$ e; f' b/ g _
; H8 e1 o0 e. K# f: @+ s+ @& t- dmp_read_fifo(gyro, accel, quat, &sensor_timestamp, &sensors,&more);% V% @( n% d( p
- if(sensors & INV_WXYZ_QUAT)* x1 r' Y0 Z# I. H1 ~3 g* u3 n
- {4 Q7 M0 P% y, @4 m* N: y
- rxbuf[0] = gyro[0];. B+ n$ c. v |: n% w/ j& g
- rxbuf[1] = gyro[1];1 O, W7 o1 Y. S
- rxbuf[2] = gyro[2];: y' H. s4 q: t& r# E8 r
- ! i. E. E. K! w8 `5 L
- printf("\r\nRead_Gyro_data gyro:\r\n");# h+ n4 l! T+ P3 s
- for (i = 0; i < 3; i++)
0 n" ~/ g/ I2 A# F( `7 C - {
$ j% B5 ~8 W7 f" n/ S" \ - printf(" %d ",gyro<i>);
, z' ?2 ~% H1 e5 D$ l - }% o: _/ |8 A, f. c
- printf("\r\n");
& j+ d5 A( I) l% w% E7 V, l: a0 k - }
+ f; t! a1 j; h Z8 U - }</i>
复制代码
e$ N( |9 V5 c( J! t1 ^9 u& x7 V! g其实参考了圆点博士的开源代码的,看了下匿名四轴下位机协议,当初试了下自己获取的数据是否正确,很不错的,下面是匿名的协议:6 F/ v( o7 p- @) Q |
+ O$ y5 F9 l( u Z/ h5 q
- /*/ W/ t5 A+ G4 c2 z- ?
- * 函数名:Data_Send_Status
2 A6 {3 I0 l$ q4 |, c - * 描述 :数据发送 传感器 的状态
5 m/ Z* i2 K) G% _6 W1 C - 根据匿名四轴最新上位机编写的显示姿态的程序
& r4 `% h$ P0 }" g - * 输入 :Pitch:俯仰角
: T3 U; w" w; _ x. Z9 S - Roll :横滚角, _ l: `& f7 T6 u$ r# W3 S7 C
- Yaw :航向角* U- y& ^' {0 d& B5 X8 c0 v
- gyro :陀螺仪 G$ H( i4 j5 v3 O' J( I a9 K
- accel:加速度
0 K, v3 u. m. J3 i - * 输出 :! D" |' m4 i a6 w$ A, f3 I
- * 调用 :
9 ^( y& M& N. p. n7 N+ X) z$ c - */ 5 ]3 L% W1 D+ |5 C5 K; f |
- void Data_Send_Status(float Pitch,float Roll,float Yaw,int16_t *gyro,int16_t *accel)
9 j7 g6 ]( d5 C2 C+ o% p1 q% t - {. ]0 l1 J. ?# a. C0 x, [0 k8 z+ T" E
- unsigned char i = 0;+ ~, U3 n P0 v& U, w
- unsigned char j = 0;
3 I, R/ M; f- Q6 o# d - unsigned char _cnt = 0,sum = 0;
) x7 c/ h6 T% H5 k4 t: c - unsigned int _temp;
% B' E/ e$ }0 }$ U; A2 T: |
% O& Z6 z6 L8 v* ]( N4 B- u8 data_to_send[12] = {0}; //发送数组,初始化为0( |3 F5 A. q8 h8 X) x
7 X2 ] {% r/ d4 a( L# R8 R j0 |- data_to_send[_cnt++] = 0xAA; // 帧头 1703 S C# Q' Z P9 C6 ?/ \
- data_to_send[_cnt++] = 0xAA; // 170
4 Y0 x4 W: P5 w5 h, X: C4 R8 H& m [: h - data_to_send[_cnt++] = 0x01; // 功能字 1
3 t6 v& m7 @+ k) c/ \6 z - data_to_send[_cnt++] = 0; // 长度 03 C) A) B6 ?& K
. E9 T2 i L( ~. o( f- //横滚角
3 c# O$ @( p6 j0 i1 ~' g" M3 B x - _temp = (int)(Roll * 100);
) j- W8 O* a2 m, g - data_to_send[_cnt++] = BYTE1(_temp); // 高 8 位% ?0 `& }+ [6 l
- data_to_send[_cnt++] = BYTE0(_temp); // 低8位0 A1 F' R! O/ ~) S/ `5 b3 p
- s8 A i) C z* q3 n
- //俯仰角% I0 g) t. `: G0 V" U( M9 q
- _temp = 0 - (int)(Pitch * 100);- c4 \: R d" B/ f+ k& i# A
- data_to_send[_cnt++] = BYTE1(_temp);
) t2 [3 q8 j! P - data_to_send[_cnt++] = BYTE0(_temp);& P' b* d$ M) H+ D4 `2 ~8 J$ X3 ?& G
- 6 m+ d! x% F5 I% ?& m2 k% F
- //航向角
! F( \, d$ X$ u& I2 } - _temp = (int)(Yaw * 100);% Y6 r/ m7 y% e: S/ s
- data_to_send[_cnt++] = BYTE1(_temp);
W E) S3 c" `; [/ j - data_to_send[_cnt++] = BYTE0(_temp);
# {% I8 q5 s6 o+ D$ h. n
: F0 ? o6 I( n) y/ u- data_to_send[3] = _cnt - 4; //数据长度
" D4 P# H* N! z* a0 o4 i1 ] - 2 |( C1 W1 o+ m$ w
- //和校验' `/ t4 c+ C/ K8 N3 {
- for(i = 0;i < _cnt;i++)
H* K4 T7 Z( P! C+ N& z' B/ K# \ - <i> sum += data_to_send;4 M! @- H5 z2 `* t6 A. u
- data_to_send[_cnt++] = sum;! `- s8 N: N( Z7 |7 E
5 W! h% O% |, u) B1 y- data_to_send[_cnt++] = '\0';" P" p+ w2 t) P0 ?. ?
- ) n! z5 i2 X# I2 @5 h
- //NRF_Tx_Dat(data_to_send); //发送到NRF缓冲区
9 j0 q" x5 M/ Q9 e" V' F' r - //printf("\r\nData_Send_Status:\r\n");. j2 u0 l* P7 c) |
- // for (j = 0; j < 12;j++)
, W. D; ]( Y! o9 H, T - // {
% X3 N4 v* I% p/ ~ - // printf(" %d ",data_to_send[j]);3 b1 `# Q3 s9 v! z
- // }
* r: [- v& s) O! ^9 [$ e - // printf("\r\n");
- u+ N2 q- \; w8 s) Z, v: L z - // //串口发送数据
q2 @1 D! V0 s5 l/ \% V. i! Y - for(i=0;i<_cnt;i++)) z- w1 `$ R* W6 ]2 y
- AnBT_Uart1_Send_Char(data_to_send);
. F* F. T" {, D) l7 _; @
* V; H$ Y* I2 K# Y( P& n1 K" a- }
0 {; Y1 Z' a" [8 g - # s) w6 `; O+ t$ e& E, D/ V
- /*' o7 r9 w) G/ b, l7 k8 d
- * 函数名:Send_Data! a. y* E# I' i8 \
- * 描述 :用于发送传感器的数据! Q" X4 f' u+ Y6 `0 D3 R6 b
- * 输入 :Gyro:陀螺仪存放字符指针3 `, i7 T# I* ~; A$ |3 N. f% s
- Accel:加速度存放指针" c' I4 N& {0 m5 J/ r
- * 输出 :; C/ N& ~# [( R+ v) i# X; ]' ~0 `
- * 调用 :
0 _: Z5 e* d& \6 a$ g - */
4 f+ R( D4 p( e; R6 K+ k2 n - void Send_Data(int16_t *Gyro,int16_t *Accel)
* U5 b4 Z% O+ ? - {
; Q* q" U+ @' }1 I7 I5 p - unsigned char j = 0;
2 _$ i( h {3 W# |! O - unsigned char i = 0;! r2 d( a2 r, m& J _+ Y
- unsigned char _cnt = 0;4 o) D/ m! ]& d7 [: F' ^
- unsigned char sum = 0;, P$ z/ R5 @! _: P. r$ b6 h" Q
- u8 status;
1 i- H3 X" @/ f5 h+ B: i+ G. g - // unsigned int _temp;9 w6 Y/ [) w. p# ~1 {; o- N
- /*
) R6 d3 g: f$ F7 R3 c# \ - 匿名数据协议:5 @ i% [ [* x1 y7 a/ [3 ^. _
- 帧头、功能字、长度(len)、数据、校验和(Sum) 共32字节. e: f# X# U# F4 M% ^ G
- 接收端在接收到数据的时候进行对应的解析即可
4 C; f2 U, I! C+ _ - */. s" q) o/ {0 c( t5 L4 A
- u8 data_to_send[12];9 X8 S2 g! J. S, z: p l$ |
- 5 r' f9 _0 W$ x- j
- data_to_send[_cnt++] = 0xAA; //帧头 AAAA
/ i- V4 u) ?$ q( E* f( ^ - data_to_send[_cnt++] = 0xAA; 7 j# V9 ~& i7 l7 {+ }+ G
- data_to_send[_cnt++] = 0x02; //功能字/ L$ l4 Z, b. i
- data_to_send[_cnt++] = 0; //长度
# \' s2 c/ B' U& M1 E8 s1 x7 ]9 I - 0 {/ G9 X' q. F
- 3 W; |2 S( U( \* _
- data_to_send[_cnt++] = BYTE1(Accel[0]);0 `8 V- g1 u2 |. U$ I: T
- data_to_send[_cnt++] = BYTE0(Accel[0]);* A9 A- v" c5 T; q( p0 p
- data_to_send[_cnt++] = BYTE1(Accel[1]); s" q" O7 T2 W0 q# j
- data_to_send[_cnt++] = BYTE0(Accel[1]);
; }% e% \4 Q% Q/ l7 ~! k - data_to_send[_cnt++] = BYTE1(Accel[2]);
, ?' T6 v" F, n1 ^ - data_to_send[_cnt++] = BYTE0(Accel[2]);) S6 {8 I( x) m9 z
- $ w# V, F0 W5 X5 g, s
- data_to_send[_cnt++] = BYTE1(Gyro[0]);
) ?6 }4 b; u- H - data_to_send[_cnt++] = BYTE0(Gyro[0]);2 |4 W/ Y% v! t, F. ~: Z4 H
- data_to_send[_cnt++] = BYTE1(Gyro[1]);
' _# y C5 Y" w G* N$ u - data_to_send[_cnt++] = BYTE0(Gyro[1]);
' ~* S Q6 K% k% @3 f+ j: L - data_to_send[_cnt++] = BYTE1(Gyro[2]);
9 D, c$ c! {1 U! t! o. z1 A - data_to_send[_cnt++] = BYTE0(Gyro[2]);
2 ~3 T9 _' G, s3 F& O4 p - data_to_send[_cnt++] = 0;
7 g( }7 m1 ^5 A( @ - data_to_send[_cnt++] = 0;
: e% c/ T( P0 F( G' R - data_to_send[_cnt++] = 0;
: G" h( ]7 o/ x, W a# i; f4 c - ) ?6 j) z) @4 h+ @/ o
- data_to_send[3] = _cnt - 4;
0 ~. q" f$ D* J" M - for(i = 0;i < _cnt;i++)- h+ }1 {8 Y3 Z) x
- sum += data_to_send;
( E! |+ M' u8 P8 l# E; S - S# o. L1 f- N, r5 r1 ?
- data_to_send[_cnt++] = sum;
/ v; [- {& ], M - $ K3 p9 f+ ^9 n: O5 N
- data_to_send[_cnt++] = '\0';, Q3 L% G! [" N; t! [- R
- . H6 _' P2 O# \+ y# \8 t! o
- // printf("\r\nSend_Data:\r\n");, ^& z. ~7 |" t5 \, Y1 n
- // for (j = 0; j < 12;j++), _1 |+ ]' T7 Y; u b
- // { W6 g$ j% S$ x' h6 G( Z
- // printf(" %d ",data_to_send[j]);
. b7 ?4 ?& D8 ?$ |5 K2 z - // }
9 P9 L/ Y1 C0 K$ B- c, ~, w6 r( ^ - // printf("\r\n");
9 G+ l& a$ B. c1 S6 S - // delay_ms(1000);
+ f- n7 l; ^ h9 u; \ - // status = NRF_Tx_Dat(data_to_send);: ] @9 G/ L, F1 p X- [. p( w
- //
* J) \3 I: Z$ Y7 v - // /*判断发送状态*/
5 a; ?3 E; E g6 z1 o: S' A - // switch(status)
6 K) }/ D7 k. H# m" i - // {
2 h8 T, _* l' F Z/ ~7 _9 L - // case MAX_RT:
2 H* `( B8 c. y3 E, b; E9 X - // printf("\r\n 主机端 没接收到应答信号,发送次数超过限定值,发送失败。 \r\n");
7 ?3 H+ Q5 k( f7 x/ T& r* \/ ?% r - // break;
6 @/ E' k+ {1 P* e* r5 _
) {4 E, [: h% }' p2 I" H# e- // case ERROR:0 V+ \4 l! e1 d* x0 M
- // printf("\r\n 未知原因导致发送失败。 \r\n");
6 s5 I+ J" T+ h/ R - // break;& N4 _0 h* h# l& m" n0 P" L5 q4 S
z7 O/ n- d, ~5 V; j! Y6 s- // case TX_DS:, ^( e% p) ^8 l7 w5 Y9 B1 [
- // printf("\r\n 主机端 接收到 从机端 的应答信号,发送成功! \r\n");
: v- u7 F' t1 y7 q7 s: C) J% O - // break;
1 I$ `- g) D: o4 Q - // }# K4 R' b9 `, B
- //
$ N& F+ x) @: q: y+ D: M - // delay_ms(1000);
) j$ h1 N! b5 K% X$ C% {6 ` - ( @/ C g# d e7 t' {
- // //串口发送数据
- _9 N& `3 }' u' ?, h2 o - for(i = 0;i <_cnt;i++)' T; x; y% j3 V/ Z9 @, ]4 D
- AnBT_Uart1_Send_Char(data_to_send);, z' L7 N* A7 K
- }</i>
复制代码 4 B3 R6 E7 T3 I4 Z5 D
在主函数中调用相应的函数即可获取相关数据,做一个简单的测试。# F: J/ j. N9 _+ X0 J4 G7 b, C0 c& H
一下是我从串口中获取的数据:
- G- ~7 E- {' u' ~8 ?
`0 `- G! ]" P q" y3 h7 o4 S" d3 I" }+ Q$ T
以及其他数据:# o5 [8 b6 m4 \( J9 [ o
. O7 I# g( Z1 d4 `5 t
7 ]7 B; S! m; e* c9 }, F9 Y
$ \+ n( N0 z& }因为代码中使用了圆点博士的开源代码,而且都是现成的,就不往出贴了……
" h2 a6 j- C" } O& v以上只是做了个简单介绍,以及获取到了数据,但是并没有说明怎样处理数据,这是很关键的也是最重要的,本次无线飞鼠的数据不好处理,我做到现在数据也不是很稳定,任然有一定幅度的变化。' w! v6 F; D$ M+ ]6 E& j/ }3 q
1 d! c/ L# x- S( E2 F: d) t. I7 e! k* Y* ?0 |; i6 m: f- [
; j1 B3 ^' Y9 Y0 T
; K' \2 F3 z: T$ E0 ^ |