main.cpp

00001 #include "mbed.h"
00002 #include "m3pi.h"
00003 
00004 m3pi m3pi;
00005 Serial pc(USBTX, USBRX); 
00006 
00007 int main() {
00008 
00009     m3pi.locate(0,1);
00010     pc.printf("Press and control the m3pi\n");
00011     while(1)
00012     {
00013         char c = pc.getc();
00014         if(c =='w')
00015         {
00016             m3pi.forward(0.5); // Forward half speed
00017             wait (0.25);        // wait half a second
00018             m3pi.stop();
00019         } 
00020         if (c =='a')
00021         {
00022             m3pi.left(0.5);    // Turn left at half speed
00023             wait (0.25);        // wait half a second
00024             m3pi.stop();
00025         }   
00026         if (c =='s')
00027         {
00028             m3pi.backward(0.5);    // Turn left at half speed
00029             wait (0.25);        // wait half a second
00030             m3pi.stop();
00031         }   
00032         if (c =='d')
00033         {
00034             m3pi.right(0.5);    // Turn left at half speed
00035             wait (0.25);        // wait half a second
00036             m3pi.stop();
00037         }   
00038         wait (2.0);
00039         
00040     }
00041 }