一. 简介
# i3 W9 @9 M/ X/ s' D, ?2 _8 CMPU6050是一款六轴陀螺仪,可以通过IIC协议输出三个方向上的加速度和角速度,在平衡车和飞控中较为常见。一般情况下,模块有用的引脚只有四个(其它的不常用),即VCC,GND,SDA和SCL。操作它的第一步,即编写IIC协议。& g+ o3 G: I) j! N. S
2 l. g- |% ?* P" z' Y二. IIC协议& r" k# A, F5 D# G- Y
作为三大常用协议之一,掌握它是非常有必要的。IIC为主从协议,分为主机和从机。IIC协议要比SPI要简单那么一点,没有像SPI那样还有模式的配置。下面就简单说说IIC协议。: C* v! a. g/ k/ c
SDA: IIC的数据线
) F. ^2 y' x5 S6 G) v! h9 Q; rSCL:IIC的时钟线2 ]( ^/ c2 L' b- i
空闲态: SDA和SCL都为高电平。7 Y* N6 Y8 g! t( y' Y
起始态: 主机将SDA拉低/ R; Y1 t: V! @: H; E
数据传输: 在SCL为低电平的时候,将数据输出,在SCL为高电平的时候,将数据输入。
! c/ f2 o* v& B, y0 S应答态:在SCL为高电平的时候,检测到SDA为低电平。
# t2 P* N/ e3 l8 u5 z" H% Y/ e非应答态:在SCL为高电平的时候,检测到SDA为高电平。$ b+ |0 z* p' B, R! z
停止态:在SCL为高电平的时候,将SDA由低拉高。
: Y$ z \' d6 O: qIIC协议一共可以分为这六种状态,接下来将简要说明如何将这六种状态组成一个完整的IIC协议,来驱动MPU6050。
9 e6 z, }7 x/ T$ T- ]$ k' n \' K1 T4 \- P+ D8 H. ~
(1). IIC写& I5 q: l Y$ ^, S
数据输出是以一个byte为单位的,从机地址一般为七位,与读写标志一起组成一个byte。0为写,1为读。
+ ]0 @% e0 X- e! a开始 -》 从机地址 + 0 -》 应答 -》发送寄存器地址 -》 应答 -》 写入数据 -》 非应答(应答) -》 停止( x' k6 U( q; r7 a
1 v3 j' h I# O) X1 W* E8 @
2 s. ~* e0 T2 a1 m5 j
! _" l4 Y2 N- f9 a5 G7 [; g8 y4 `(2). IIC读! T# q8 g6 d7 }* ?: o: z
IIC读数据要比IIC写数据要复杂一点,主要是步骤上多了几步,但是状态什么的都完全一样。
6 k7 v! }3 B& Z8 T8 j7 l# `6 B) E6 n$ U5 {% J' o1 ]' \: {' T
开始 -》 从机地址 + 0 -》 应答 -》发送读取寄存器地址 -》 应答 -》开始 -》 从机地址 + 1 -》 读取数据 -》应答 -》 停止- Y7 z5 A. V* h# N% ?- x0 Y) C V- P# C
) d4 k% D/ x }可以看到,只要将这几个状态实现了,按照这个流程就可以很容易实现IIC的读和写。大概的时序图如下。
: i2 h0 |4 H" ?6 ?) T. C( p) g0 d% y5 {
3 x: P" g1 h% Z9 h3 l1 G: s" z7 c) e( M0 y1 c6 T5 q8 t
三. 代码实现/ ~, c; N7 K1 h# P1 L- u
根据上面的六个状态,定义出对应的六个函数,对应的只有五个,空闲态忽略,因为经过Stop后,IIC的时钟线和数据线都已经为高了。delay时间需要根据从机所能接受的最大速率来决定,不然的话,会出错,下面就来详细说明这几个函数。( }- h3 F& j" ~$ _. P
( U5 X& }1 _" Q1 |* l
8 F9 I, I# q# j1 ] b1 Y1 T
$ I" R; _; _* S/ g7 D% U! C
(1) MPU6050IICDelay(void)8 O* m# p2 H: S R ]& q" o
这就不用说明什么了6 T- {- O. s7 j* M( C* ?0 e% W# ~8 z
+ A. _) [* e, a9 P7 J- void MPU6050IICDelay(void) N+ _3 V3 o6 w; Q' F3 A) z
- {
- ~! t' W5 D5 |0 p - uint16_t i = 250;- f: I2 F! k' i" g! G
- while(i--);8 r9 r+ L) s9 n: }, k! o
- }
复制代码
9 F6 Q0 o6 d R* y( E1 \, r) a(2) MPU6050IICStart(void)* A. i/ p; y( e9 G
将SDA配置为输出模式。然后将SCL和SDA全部拉高,dealy后,将SDA拉低,就ok了。
; j! j9 i% J, y, d9 Z! P7 L9 M- T
- void MPU6050IICStart(void)
: ]- ]. T2 i. \% Q, \ f3 S; @ - {
4 i, D7 V7 ]* d+ }. l1 ] - SetSDAOut();" c$ h/ N6 h1 K4 ~3 a$ }% [7 [
- SCLHigh();1 p" @8 Z) |" V# Y' J) W% ^; e( C
- SDAHigh();" V! T6 r7 i) b5 l" {' Q0 @7 l
- MPU6050IICDelay();
* {3 C0 V' t% A H; d - SDALow();6 A8 |( ?4 q- ^; ^
- MPU6050IICDelay();
) ]! S# g9 f% Y6 h - }
复制代码
$ R/ b9 O. q8 \3 s(3) MPU6050IICACK(void)
/ a: l0 }( n) K" _这里只包含了从机应答。
8 O' C4 x& a/ e' A# m% K }' M: ~% `6 W1 M3 H' l% f6 Y% a; c
- void MPU6050IICACK(void)% D @3 Y G1 i$ C$ P
- {
2 q! k- P: Q% G7 P. ? - SCLLow();
! X# j% d) N# k7 m; |. Q - MPU6050IICDelay();4 Y& n$ t! _% j6 B) i7 G9 l; n. s- k
- SetSDAIn();
6 e0 A6 }0 p8 B& P" M3 r% R" l - MPU6050IICDelay();
( c8 K0 V' o& N* z- W4 a" K ]! T - SCLHigh();+ n2 @1 p$ z3 E: W* { G
- MPU6050IICDelay();
7 O2 J0 b& [! P0 E - SDARead();
, R* q- l5 Q8 o7 h - MPU6050IICDelay();0 m- X$ P. Y9 Z! R( G D3 Y
- SCLLow();1 A V& Y6 k2 K6 m
- }
复制代码
; B& Q: C, a. ?% A; ?9 t9 i5 \(4) MPU6050IICStop(void)
! x' m, S! Q2 z& w8 r停止位这里,需要先将SCL和SDA都拉低,然后先将SCL拉高,后将SDA拉高,2 K* w# z( G( |+ J. x
) ^5 d3 ~3 e. z+ n! g( U. h
- void MPU6050IICStop(void)0 ?" @3 }- y* X4 w/ \0 N1 X8 y" b7 V9 z
- {
, r8 {+ {7 v; r: ^' K5 j - SetSDAOut();
) p$ ^9 x$ e9 _; Y0 G - MPU6050IICDelay();: c" y* k2 p8 I c: U4 ?& b& A
- SCLLow();; @1 [7 X# h/ A5 J; K7 v
- MPU6050IICDelay();+ x- T" y S( e0 k& `
- SDALow();
: K4 u: H0 }. T' o% J4 T - MPU6050IICDelay();
% ^* G* D; L% ~% P- V0 Q; ~ - SCLHigh();; O! X0 C( ?/ j/ L; x
- MPU6050IICDelay();1 c: g9 \* V. `" s f1 Y* \4 v
- SDAHigh();) @+ v2 H4 m9 V) _* D
- MPU6050IICDelay();
3 a! ~* ]- m3 v* W - }
复制代码
7 u9 y r% _5 i* n6 Q ?9 m: L/ w(5) MPU6050IICWrite(void): M8 A/ s- | j) S
- void MPU6050IICWrite(uint8_t data)
/ W) Y; x0 @ R$ I8 K0 ^ - {
" [& M% a2 K( g - uint8_t i;2 z) q9 E( f+ g( K, _" w
- SetSDAOut();: {; S! r Q8 M/ q! I, p
- MPU6050IICDelay();" k; V* i4 J( [
- for(i = 0 ; i < 8; i++)
8 \6 L% C! H7 q - {# A- H2 K; b5 E7 \, I y# }
- SCLLow();) t/ Y' t- o& E* `. ~
- MPU6050IICDelay();
& e n$ v' r9 G0 k$ S - if(data & 0x80)6 \2 P2 A6 F O0 f- ]
- SDAHigh();! {1 `% V" d: I# n" Q7 ]5 }
- else7 _) @, A5 d7 }2 y% ^2 @
- SDALow();$ _ C; d6 z+ f
- data = data << 1;
! C* `0 j/ x [4 e - MPU6050IICDelay();2 S& k" ^) i7 {* F
- SCLHigh();
# ?0 ]9 S& _6 d& _# q - MPU6050IICDelay();7 v9 N. ~7 \) S: S
- }" k" j# h) M0 q! o, D" s. w2 ?! V; p
- }
复制代码 1 t/ S1 L7 W1 j: i4 S+ d
(6) MPU6050IICRead(void)
4 o& r9 t' }: y/ _" s# _$ l) S- uint8_t MPU6050IICRead(void)! P+ w0 V' [/ M( L: `
- {
- J3 f* W' l; b2 \# ] - uint8_t i;6 P- M0 G% I) D
- uint8_t data = 0;
# E8 K* s' U: I! y* z% { - SetSDAIn();
& @0 ]/ `7 ?3 k6 @7 `$ B9 `% d - MPU6050IICDelay();
' d! u* |: S. c1 X2 q% ~5 j - for(i = 0;i < 8; i++)
* n$ P- A! E$ {' R! q/ {' w% o& f - {$ R& ?6 [" ~$ z- ]4 e6 Y
- SCLLow();% K! o) Q/ n+ }- g8 d
- MPU6050IICDelay();, j' ?1 b0 G l; L; t# |0 C. i4 K
- SCLHigh();* h H2 d' J8 a
- MPU6050IICDelay();" [, w. T( T; o: ~% w. c
- if(SDARead()), z0 O- M, V: j2 l
- data = data | 0x01; `( R, X, l2 W" ~! _% l) M+ c
- else) k5 o2 P/ r* a
- data = data | 0x00;* P$ c" w; r6 N0 A
- data = data << 1;8 b- M) W; \( C" _( ^
- MPU6050IICDelay();
0 g; g7 [4 e; @3 F! H - }% w) H' T1 o/ s4 ~5 s. e% J
- return data;
2 g6 z! O% m+ }, ^& r0 u5 b - }
复制代码 1 b7 Y6 \/ R+ c7 m0 F4 {0 r( s [
读写数据,可以搭配时序图来,都是将SCL为低的时候,将数据送出去。在SCL为高的时候,接收数据。2 B5 ~- y5 |) `( l2 U! w
然后将上面的这几个函数依次组合成读写两个函数
9 N7 q- }( W4 r* \5 N# v6 ^* S3 H( N+ Q* Y# s+ M
! C0 v+ B; E5 x/ \4 r
: p6 b4 ?6 U0 I) ~7 T' N这里IIC驱动编写完成。# i1 g) |5 x9 b! ^5 Q; a5 }
& z2 o0 v9 P$ |: e8 P
四. MPU6050 初始化
) |7 @5 y4 D8 F; Y8 t0 v9 D初始化的实质就是对寄存器进行配置,这就要查看芯片手册,了解每一个寄存器的作用了,以及初始化的时候寄存器配置的顺序。/ c% Q2 x; u5 e
这里将重要的寄存器列举出来了
0 M0 Q1 Y. R; l+ v1 g4 n6 v: G
& k$ m8 t9 W4 y. {) G7 m' Y- #define MPU6050Addr 0xD0
# d0 k6 d6 p) j/ Y/ [* g3 i - #define ACCEL_XOUT_H 0x3B
8 P9 H' q# O6 g; F( f - #define ACCEL_XOUT_L 0x3C
9 a0 q9 [; N- \% \% P - #define ACCEL_YOUT_H 0x3D
& v( r3 G F. `% `5 ~/ y( H - #define ACCEL_YOUT_L 0x3E
4 T0 T6 m8 b- f5 L( d - #define ACCEL_ZOUT_H 0x3F1 J% v [, M9 x* q
- #define ACCEL_ZOUT_L 0x40/ ?* |& P! N3 Z9 k
- 0 j, Z# M. T" B& @
- #define GYRO_XOUT_H 0x43
( G$ H+ s8 X9 W1 O) q! D - #define GYRO_XOUT_L 0x44
0 P! @1 Q8 X7 I - #define GYRO_YOUT_H 0x45
0 U: d! }$ L; U* l! D - #define GYRO_YOUT_L 0x464 G2 d2 z2 D0 @- g- ` a/ t- i) X# x; @; f
- #define GYRO_ZOUT_H 0x478 ]" Z5 A5 [4 B! c! B6 \1 R3 h, j, t
- #define GYRO_ZOUT_L 0x484 N) k# f" n5 ]! o5 c, P) x# E
- ) ?/ Y$ G2 q! i) J2 X
- #define PWR_MGMT_1 0x6B1 L X7 p" l; Y" T0 G! o R7 e
- #define PWR_MGMT_2 0x6C0 m% @8 ^) K$ Z6 U1 b1 F0 E
- #define SMPLRT_DIV 0x19
- u1 p# S; \( x/ @% Y% p8 D - #define MPU_CONFIG 0x1A
: u4 Y, P/ T. G3 q- w - #define GYRO_CONFIG 0x1B: ^ }. b( k( l% O" J$ S7 O
- #define ACCEL_CONFIG 0x1C+ Z7 a! g" } {! j
- 1 |2 W. A# R9 \% ]
- #define MPU6050ID 0x75
复制代码
{$ [' P6 d( B3 `0 r8 e+ r(1). 初始化, B; K+ s' Z" e1 H0 d+ w! n$ Q
- /*MPU6050初始化*/
, a9 W* t S" s# U+ I. S% r - void MPU6050Init(void)5 O! M( E2 V0 p2 {3 _) L
- {$ T4 R/ Y9 q6 R( W3 N4 E) f
- MPU6050GPIOInit();
: W0 w2 m/ m5 e( e+ { - MPU6050IICWriteRegister(MPU6050Addr,PWR_MGMT_1,0x80);
- A4 Q; u0 \2 }7 u5 N# d. l - rt_thread_mdelay(100);
7 z9 {& e( B: ~7 p. C6 ? - MPU6050IICWriteRegister(MPU6050Addr,PWR_MGMT_1,0x00);2 [; s6 N) ]9 {8 o
- MPU6050IICWriteRegister(MPU6050Addr,SMPLRT_DIV,0x00);5 O% x H" x* M9 b! V! G
- MPU6050IICWriteRegister(MPU6050Addr,MPU_CONFIG,0x03);8 S- P/ t& B& O
- MPU6050IICWriteRegister(MPU6050Addr,GYRO_CONFIG,0x18);// gyro scale :+-2000°/s
e& i8 C5 z* O; _& F9 A - MPU6050IICWriteRegister(MPU6050Addr,ACCEL_CONFIG,0x10);// Accel scale :+-8g (65536/16=4096 LSB/g)
% [# d) x5 i( Z, K: v0 ~. p9 f - MPU6050IICWriteRegister(MPU6050Addr,0x6B,0x01);( y; y4 @4 J3 m j3 n- T1 [% Z
- }
复制代码 (2)验证
9 N$ t* m( B V3 O; u2 f" e8 q8 Y通过读取芯片的ID,可以确定IIC是否有问题。5 E. d5 b* I3 G* c3 L' j! z, o; {
# e" @- @* J" T' ]9 ?
- /*读取MPU6050的ID*/
% M* R0 l, z, ]3 t/ W - uint8_t MPU6050GetId(void)
5 J% \/ ?" G6 Y% w$ o) O - {
" n$ ~' C5 l0 U T4 h/ b3 T - return MPU6050IICReadRegister(MPU6050Addr,MPU6050ID);
7 X, z; Q6 ^/ |5 `0 r% M! |- U - }
复制代码
& E4 F2 S& V1 ~, c9 ?3 t5 y, r————————————————
) g3 \ ~. P: O2 O版权声明:ValentineHP1 T- Q; B: M1 J
& _8 |/ A; C0 P1 ^( g
& l* ~- B5 Z: s, B. w0 \ ~3 }, S
4 X) F$ O3 Y5 g |