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);}
}
}