简单利用mpu6050 lib,进行测试,接开发板D7,D8针2 U6 A. h- _8 [: i1 ^
代码如下; i1 ^# ?2 _1 h6 j
- #include "mbed.h"
P1 N- ^+ a( V' B" I, i - #include "MPU6050.h"( w* h# f# F- P% X, E6 n
-
% V V1 T# w2 t' z( p& ` - MPU6050 mpu(D7,D8);//for Nucleo-F042K6
+ o3 `% e1 c' J7 ?# M- w* e - Serial pc(USBTX,USBRX);6 u/ ^% ~% S& O% d4 e
- % |1 m. a; H" E* f
- float gx,gy,gz,ax,ay,az;
1 U) {8 x6 W+ g0 @ -
. K3 c7 m- N5 X - int main()8 S4 o1 p3 u9 U8 p/ e2 ~6 ?4 ]. d
- {3 T8 L% k$ O. G/ g
- pc.baud(115200);
+ B- b: | u5 F% m - if(mpu.getID()==0x68) {
9 j9 b2 B( A7 G$ ^4 W - pc.printf("MPU6050 OK");; `+ H& B: L" U K
- wait(1);
) k( a1 K- i& p - } else {
: M' a: `" M7 x+ Q - pc.printf("MPU6050 error ID=0x%x\r\n",mpu.getID());: Y# O( o; D4 V
- while(1) {* h3 l5 t/ T1 \: _2 k1 M
- }
8 `1 i [+ o% u+ w: ] - }3 Q7 s) @+ Q! ]- j& w
- mpu.start();
8 O! V Q$ ~ e) h, \- n* m. b - while(1) {4 x) n( q- @2 Z( h7 t
- mpu.read(&gx,&gy,&gz,&ax,&ay,&az);& w; `$ S9 N- J9 K+ n8 H
- pc.printf("gx,gy,gz,ax,ay,az %.1f,%.1f,%.1f,%.2f,%.2f,%.2f\r\n",gx,gy,gz,ax,ay,az);
' S) h! R: B+ } d, T( J - wait(0.1);
7 g, q" C, y- W - }
5 ?9 G, j9 D5 u2 f ?* F* | - }, ? N$ V3 _; \$ G/ q! ~. j% k: T/ }
-
复制代码 mbed os下写代码是不是很简单, `+ n' ?. i8 ~
|
搜一下,mbed下有很多的,引入进来即可。