简单利用mpu6050 lib,进行测试,接开发板D7,D8针2 W: f2 a# N, T8 x+ w
代码如下# S+ G) `- x/ C, @$ l; c
- #include "mbed.h"
( L0 M! z! W1 I3 t: k - #include "MPU6050.h"
1 y! H, |5 E% c+ Y7 ] -
8 U; s, b' o: G - MPU6050 mpu(D7,D8);//for Nucleo-F042K6
# w* R6 t' u0 `9 x( K* E7 o - Serial pc(USBTX,USBRX);
3 B1 L, j2 y7 i# ]6 s -
5 K8 N+ \/ n$ l5 A& ` u - float gx,gy,gz,ax,ay,az;
/ t% ]: z) ~2 N0 a0 W -
* ?! S ^. I/ T - int main()) ]/ I5 \7 C5 r. j
- {
. C. W( _; z- N/ K. \' V& h - pc.baud(115200);. X# k6 K4 J) p) R6 C# _
- if(mpu.getID()==0x68) {
# Z) l# ?( o. N& p; a - pc.printf("MPU6050 OK");
Q. B+ s1 c6 u+ Z* [% l - wait(1);' |9 |7 i7 D0 l# f5 n" x' @
- } else {6 f9 E5 s L9 l$ o
- pc.printf("MPU6050 error ID=0x%x\r\n",mpu.getID());) Z& ?& V# u0 O5 N' R9 [
- while(1) {
' e7 F) a/ A' a/ z- t - }
4 M* o- c1 U4 e - }8 [" b9 U! g* x/ Y
- mpu.start();
2 g, ^$ v$ z, S4 r( q5 z% R - while(1) {
2 P- W; `% d0 }2 q2 T. x - mpu.read(&gx,&gy,&gz,&ax,&ay,&az);
* J- a3 p, ^0 p1 w& w - pc.printf("gx,gy,gz,ax,ay,az %.1f,%.1f,%.1f,%.2f,%.2f,%.2f\r\n",gx,gy,gz,ax,ay,az);2 q: t" E* B- d* k+ \0 s3 \: v* k
- wait(0.1);
% t& s' A m; g9 w* s4 |5 }3 ?# p: @ - }
0 u! c; Q m' [3 C. y, e3 h - }0 C$ D9 D& L2 F1 J! J" c( i
-
复制代码 mbed os下写代码是不是很简单6 @/ w' V) F; o
|
搜一下,mbed下有很多的,引入进来即可。