LIN JINWU / Mbed 2 deprecated MPU6050_test

获取mpu6050 六轴传感器数据，从打印串口中输出

Dependencies:   mbed MPU6050

main.cpp@2:6e9393d9cc11, 2019-08-15 (annotated)

Committer:
ritarosakai
Date:
Thu Aug 15 03:42:49 2019 +0000
Revision:
2:6e9393d9cc11
Parent:
1:01af59327884 
Fix doxygen

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ritarosakai 0:5efae55d7fbb 1 #include "mbed.h"
ritarosakai 0:5efae55d7fbb 2 #include "MPU6050.h"
ritarosakai 0:5efae55d7fbb 3
ritarosakai 2:6e9393d9cc11 4 MPU6050 mpu(D4,D5);
ritarosakai 0:5efae55d7fbb 5 Serial pc(USBTX,USBRX);
ritarosakai 0:5efae55d7fbb 6
ritarosakai 0:5efae55d7fbb 7 float gx,gy,gz,ax,ay,az;
ritarosakai 0:5efae55d7fbb 8
ritarosakai 0:5efae55d7fbb 9 int main()
ritarosakai 0:5efae55d7fbb 10 {
ritarosakai 0:5efae55d7fbb 11 pc.baud(115200);
ritarosakai 0:5efae55d7fbb 12 if(mpu.getID()==0x68) {
ritarosakai 0:5efae55d7fbb 13 pc.printf("MPU6050 OK");
ritarosakai 0:5efae55d7fbb 14 wait(1);
ritarosakai 0:5efae55d7fbb 15 } else {
ritarosakai 0:5efae55d7fbb 16 pc.printf("MPU6050 error ID=0x%x\r\n",mpu.getID());
ritarosakai 0:5efae55d7fbb 17 while(1) {
ritarosakai 0:5efae55d7fbb 18 }
ritarosakai 0:5efae55d7fbb 19 }
ritarosakai 0:5efae55d7fbb 20 mpu.start();
ritarosakai 0:5efae55d7fbb 21 while(1) {
ritarosakai 0:5efae55d7fbb 22 mpu.read(&gx,&gy,&gz,&ax,&ay,&az);
ritarosakai 0:5efae55d7fbb 23 pc.printf("gx,gy,gz,ax,ay,az %.1f,%.1f,%.1f,%.2f,%.2f,%.2f\r\n",gx,gy,gz,ax,ay,az);
ritarosakai 0:5efae55d7fbb 24 wait(0.1);
ritarosakai 0:5efae55d7fbb 25 }
ritarosakai 1:01af59327884 26 }