AHRS MPU6050

Dependencies:   MPU6050_tmp mbed

main.cpp

Committer:
pommzorz
Date:
2013-06-22
Revision:
0:470f01cb2094

File content as of revision 0:470f01cb2094:

#include "mbed.h"
#include "MPU6050.h"
#include "GurvIMU.h"


//#define     PI 3.1415926535897932384626433832795
GurvIMU imu;

DigitalOut myled(LED1);
Serial pc(USBTX, USBRX);
float euler[3];
float av[4];
    
int main() {
    pc.baud(921600);//init la liaison série a la vitesse max
    pc.printf("Init\r\n");
    imu.init();
    while(1) {
        //imu.getYawPitchRollRad(euler);
        //pc.printf("Yaw : %f , Pitch : %f , Roll : %f \r\n" , euler[0], euler[1], euler[2]);
        imu.getVerticalAcceleration(av);
        pc.printf("%f\r\n",av[3]);
        wait_ms(10);
    }
}