Dependencies:   mbed

Main.cpp

Committer:
vcazan
Date:
2010-01-17
Revision:
0:552b174f8c2f

File content as of revision 0:552b174f8c2f:

#include "mbed.h"
#include "Motor.h"

Motor m(p23, p16, p17);
Motor m2(p24, p18, p19);
DigitalOut myled(LED1);
DigitalOut myled2(LED2);


int main() {

    // wind up to full speed
    for (float speed=0.0; speed < 1.0 ; speed += 0.01) {
       m.speed(speed); 
       m2.speed(speed-0.6);
       wait(0.02);
       myled = 0;
       myled2 = 1;
    }


    while(1) {
        myled = 1;
        myled2 = 0;
        // Go from full speed forward, to full speed reverse
        for (float speed=0.6; speed > -1.0 ; speed -= 0.1) {
        m.speed(speed); 
        m2.speed(speed);
        myled = 0;
       myled2 = 1;
        wait(0.02);}

        // Go from full speed reverse, to full speed forward
        for (float speed=-0.6; speed < 1.0 ; speed += 0.1) {
        m.speed(speed); 
        m2.speed(speed);
        myled = 1;
       myled2 = 0;
        wait(0.02);}
    }
}