Sample for MPU6050 (used by Nucleo-STMF303K8)

Dependencies:   MPU6050 mbed

main.cpp

Committer:
mikawataru
Date:
2016-06-17
Revision:
0:83aeb4287ca7
Child:
1:e24f8a7fc545

File content as of revision 0:83aeb4287ca7:

#include "mbed.h"
#include "MPU6050.h"
#define acc 16384
#define gyro 131

DigitalOut myled(LED1);
MPU6050 mpu(D4,D5);
Serial pc(USBTX, USBRX);

int main() {
    float a[3];
    float g[3];
    mpu.setAcceleroRange(0);
    mpu.setGyroRange(0);
    while(1) {
        myled = 1;
        wait(0.2);
        myled = 0;
        wait(0.2);
        a[0] = (float)mpu.getAcceleroRawX()/acc;
        a[1] = (float)mpu.getAcceleroRawY()/acc;
        a[2] = (float)mpu.getAcceleroRawZ()/acc;
        g[0] = (float)mpu.getGyroRawX()/gyro;
        g[1] = (float)mpu.getGyroRawY()/gyro;
        g[2] = (float)mpu.getGyroRawZ()/gyro;
        pc.printf("%f,%f,%f,%f,%f,%f\n",a[0],a[1],a[2],g[0],g[1],g[2]);
    }
}