Vlad Cazan
/
Motor
Diff: Main.cpp
- Revision:
- 0:552b174f8c2f
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Main.cpp Sun Jan 17 17:17:06 2010 +0000 @@ -0,0 +1,41 @@ +#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);} + } +} \ No newline at end of file