mpu6050

Dependencies:   MPU6050 mbed

Committer:
oakx
Date:
Wed Jul 02 16:19:28 2014 +0000
Revision:
0:db87af04ff89
hello

Who changed what in which revision?

UserRevisionLine numberNew contents of line
oakx 0:db87af04ff89 1 #include "mbed.h"
oakx 0:db87af04ff89 2 #include "MPU6050.h"
oakx 0:db87af04ff89 3
oakx 0:db87af04ff89 4 DigitalOut myled(LED1);
oakx 0:db87af04ff89 5 Serial pc(USBTX, USBRX);
oakx 0:db87af04ff89 6 MPU6050 mpu;
oakx 0:db87af04ff89 7
oakx 0:db87af04ff89 8 int16_t ax, ay, az;
oakx 0:db87af04ff89 9 int16_t gx, gy, gz;
oakx 0:db87af04ff89 10
oakx 0:db87af04ff89 11 int main()
oakx 0:db87af04ff89 12 {
oakx 0:db87af04ff89 13 pc.baud(9600);
oakx 0:db87af04ff89 14 pc.printf("MPU6050 test\n\n");
oakx 0:db87af04ff89 15 pc.printf("MPU6050 initialize \n");
oakx 0:db87af04ff89 16
oakx 0:db87af04ff89 17 mpu.initialize();
oakx 0:db87af04ff89 18 pc.printf("MPU6050 testConnection \n");
oakx 0:db87af04ff89 19
oakx 0:db87af04ff89 20 bool mpu6050TestResult = mpu.testConnection();
oakx 0:db87af04ff89 21 if(mpu6050TestResult) {
oakx 0:db87af04ff89 22 pc.printf("MPU6050 test passed \n");
oakx 0:db87af04ff89 23 } else {
oakx 0:db87af04ff89 24 pc.printf("MPU6050 test failed \n");
oakx 0:db87af04ff89 25 }
oakx 0:db87af04ff89 26
oakx 0:db87af04ff89 27 while(1) {
oakx 0:db87af04ff89 28 wait(1);
oakx 0:db87af04ff89 29 mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
oakx 0:db87af04ff89 30 //writing current accelerometer and gyro position
oakx 0:db87af04ff89 31 pc.printf("ax = %d ,ay = %d ,az = %d , gx = %d, gy = %d, gz = %d\n",ax,ay,az,gx,gy,gz);
oakx 0:db87af04ff89 32 }
oakx 0:db87af04ff89 33
oakx 0:db87af04ff89 34 }