Main.cpp

00001 #include "mbed.h"
00002 #include "Motor.h"
00003 
00004 Motor m(p23, p16, p17);
00005 Motor m2(p24, p18, p19);
00006 DigitalOut myled(LED1);
00007 DigitalOut myled2(LED2);
00008 
00009 
00010 int main() {
00011 
00012     // wind up to full speed
00013     for (float speed=0.0; speed < 1.0 ; speed += 0.01) {
00014        m.speed(speed); 
00015        m2.speed(speed-0.6);
00016        wait(0.02);
00017        myled = 0;
00018        myled2 = 1;
00019     }
00020 
00021 
00022     while(1) {
00023         myled = 1;
00024         myled2 = 0;
00025         // Go from full speed forward, to full speed reverse
00026         for (float speed=0.6; speed > -1.0 ; speed -= 0.1) {
00027         m.speed(speed); 
00028         m2.speed(speed);
00029         myled = 0;
00030        myled2 = 1;
00031         wait(0.02);}
00032 
00033         // Go from full speed reverse, to full speed forward
00034         for (float speed=-0.6; speed < 1.0 ; speed += 0.1) {
00035         m.speed(speed); 
00036         m2.speed(speed);
00037         myled = 1;
00038        myled2 = 0;
00039         wait(0.02);}
00040     }
00041 }