Pedro Enrique Vidal Peñas / Mbed 2 deprecated quadcopter

Gestion de imu y arranque de motores cuadcopter primera fase

Dependencies:   mbed Servo

main.cpp

Committer:
cr0n0s20
Date:
2011-02-22
Revision:
0:ce49c05e9d73

File content as of revision 0:ce49c05e9d73:

#include "mbed.h"
#include "Servo.h"
#include "main.h"
#include "9dof.h"

Servo motor(p21);

Serial pc(USBTX, USBRX);
dof9RazorImu Razor(p9, p10);

int main() {



    armarESC();
    wait_ms(10000);
    for (int i = 0; i < 50000; i++) {
        motor = 50.0;

        Razor.update();
        pc.printf("%d\r\n", Razor.getGyroZ());
        wait(0.5);

    }

}
//Función para armar el ESC
void armarESC() {
    wait_ms(10000);
    motor = 0.0;
    wait_ms(10000);
    motor = 11.56;
}