Pop lock n drop it

Dependencies:   m3pi_ng mbed

main.cpp

Committer:
vsal
Date:
2014-05-20
Revision:
0:80d9725a7342
Child:
1:ac7fc0b5f878

File content as of revision 0:80d9725a7342:

#include "mbed.h"
#include "m3pi_ng.h"

DigitalOut myled(LED1);
m3pi huey;

int main() {
    //prints battery voltage on led screen
    float bat = huey.battery();
    huey.printf("%f",bat);
    
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.5);
    
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.5);
    
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.5);
    
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.5);
    
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.5);
    
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.1);
    huey.forward(0.1);
    wait(0.1);
    huey.backward(0.1);
    wait(0.5);
    
    
    
    huey.stop();
    
    
    
    
    while(1) 
    {
        myled = 1;
        wait(0.2);
        myled = 0;
        wait(0.2);
    }
}