main.cpp

00001 #include "mbed.h"
00002 #include "ur_Bertl.h"
00003 #include "const.h"
00004 
00005 
00006 Serial bt(p9, p10);
00007 
00008 int main ()
00009 {
00010     ur_Bertl karel;
00011     int beeper = 0;
00012     int weg = 0;
00013      while(!karel.IsButtonPressed(BTN_FM))
00014     {
00015          while(!karel.NextToABeeper())
00016         {
00017             karel.Move();
00018         }
00019         beeper++;
00020         bt.printf("Beeper: %d", beeper);
00021         
00022         karel.Move();
00023         weg++;
00024     }
00025     
00026     karel.TurnLeft();
00027     
00028     for (int a = 0; a < beeper; a++)
00029         {
00030             karel.Move();
00031         }
00032         
00033     karel.TurnLeft();
00034     
00035     for (int a = 0; a < weg; a++)
00036     karel.Move();
00037     
00038     karel.TurnLeft();
00039     
00040     for (int a = 0; a < beeper; a++)
00041         {
00042             karel.Move();
00043         }
00044 }