Oskar Weigl / Mbed 2 deprecated Quadcopterv2

This is for ICRS\' second generation Quadcopter

Dependencies:   mbed

main_init.h

Committer:
madcowswe
Date:
2011-11-18
Revision:
0:0bbf2f16da9c

File content as of revision 0:0bbf2f16da9c:



void main_init() {

    //Emergency stop button
    Nkill.mode(PullDown);

    pc.printf("Hello World!\r\n");

    initmotor();

    /*
    //Init motor pwm
    left.period_ms(20);
    left = 0.01;
    right.period_ms(20);
    right = 0.01;

    front.period_ms(20);
    front = 0.01;
    rear.period_ms(20);
    rear = 0.01;
    */

    pc.printf("Motors initialized\r\n");

    //Setup accelerometer
    setupaccel();
    pc.printf("Accelorometer initialized\r\n");

    //Setup gyros, and calibrate them
    wait(0.5);
    calibgyro();
    pc.printf("Gyros initialized and calibrated\r\n");

}