File content as of revision 0:e90affc366bf:

#include "ur_Bertl.h"
#include "mbed.h"
#include "Robot.h"
#include "const.h"

Serial bt(p9, p10);

void main()
{
    ur_Bertl karel;
    
    int Beeper = 0;
    int Movez = 0;
    
    
    while (karel.FrontIsClear())
    {
        karel.Move();
        Movez++;
        if (karel.NextToABeeper())
        {
            Beeper++;
        }
        bt.printf("Beeper: %d \n", Beeper);
        bt.printf("Move: %d \n", Movez);
        wait(1);
                            
    }
    if (!karel.FrontIsClear())
    {
        karel.TurnLeft();
        for(int i = 0; i < Beeper; i++)
        {
        karel.Move();
        }
        karel.TurnLeft();
        for(int a = 0; a < Movez; a++)
        {
        karel.Move();
        }
        karel.TurnLeft();
        for(int i = 0; i < Beeper; i++)
        {
        karel.Move();
        }
        karel.ShutOff();
    }
    
}