简单利用mpu6050 lib,进行测试,接开发板D7,D8针
# J" e) y. R9 k1 l; k% G4 Q# D9 S代码如下" L/ T. T# a* i5 @+ _. S
- #include "mbed.h"
. D6 r) ~ m8 J( J$ Y* C - #include "MPU6050.h"
$ X6 Z3 V8 G7 v2 Z$ u( I' a: L' U0 ^ - 8 {: b4 }8 \. n1 u0 l+ y! g& J4 g: J
- MPU6050 mpu(D7,D8);//for Nucleo-F042K6
5 `8 ]5 I4 k; G7 z9 N - Serial pc(USBTX,USBRX);
9 t/ R& y; _; O e0 P: W -
+ D% Q; I e# a: l7 F - float gx,gy,gz,ax,ay,az;
6 T; k/ N& z8 g' Y- c% k) S8 y; P# z -
" _. U5 M3 o8 g! { - int main()
' Q$ X1 r1 a9 f. N* i4 ? - {
/ V4 T! L4 H- A9 W2 c- U3 ]9 s - pc.baud(115200);
5 ~' H5 _; q% ]$ `+ T z+ ~. D - if(mpu.getID()==0x68) {
1 O9 t+ z& H* o+ v$ N' ? - pc.printf("MPU6050 OK");1 M# f! v+ f: s0 |% M( ?( [
- wait(1);- f+ \$ ?" N5 D5 ~' v, R: Q4 k
- } else {0 A' v: y2 J/ d) M2 Y
- pc.printf("MPU6050 error ID=0x%x\r\n",mpu.getID());
* v, l9 G0 Q! e+ b/ Y* z3 t- j - while(1) {
+ G5 C* y+ p- \! Y# u9 g1 q - }# H+ d5 n2 H5 `2 ~5 e, _
- }
; U N! j; q: p% A- W* Y/ T% m - mpu.start();* H) l9 t/ `0 D, I! s
- while(1) {
% e% v4 o, a& A' M1 ^ - mpu.read(&gx,&gy,&gz,&ax,&ay,&az);* \, d3 v0 C+ X: w/ q3 a
- pc.printf("gx,gy,gz,ax,ay,az %.1f,%.1f,%.1f,%.2f,%.2f,%.2f\r\n",gx,gy,gz,ax,ay,az);$ q+ r- b( G( @/ b6 _
- wait(0.1);. I8 Q+ G, b) Z* B5 i5 F
- }
( L+ s, c6 Y, i( f6 `- ` - }
: S1 \6 e1 M0 x o! g, C. d -
复制代码 mbed os下写代码是不是很简单
4 J- U( v8 X: E |
搜一下,mbed下有很多的,引入进来即可。