Sammelt Beeper auf :) Wenn Bertl auf eine Wand zukommt dreht er sich um (Muss noch umändern) Programm ist aber noch nicht fertig :)

Dependencies:   ur_Bertl mbed

Fork of While_Task3 by Martina Le

main.cpp

Committer:
martinale
Date:
2015-05-08
Revision:
2:8994684be6dc
Parent:
1:af4b812a6957

File content as of revision 2:8994684be6dc:

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

int Beeper=0;

class Bertl_Beeper : public Bertl
{
public:
    void ClearAllBeeperToTheWall();
    void TurnAround();
};

void Bertl_Beeper :: TurnAround()
{
    TurnLeft();
    TurnLeft();
}

void Bertl_Beeper :: ClearAllBeeperToTheWall()
{
    while(FrontIsClear()) 
    {
        if(NextToABeeper()) 
        {
            PickBeeper();
            Beeper++;
            NibbleLeds(AnyBeeperInBag());
            wait(1);
            Move();
            
        } else
            Move(25);

    }
}

int main()
{
    Bertl_Beeper karel;
    
    karel.TurnLedOff(LED_ALL);

    while(1) 
    {
        karel.ClearAllBeeperToTheWall();
        while(!karel.FrontIsClear()) 
        {
            karel.TurnLeft();
            karel.Move(Beeper);
            break;
        }
      
    }
    
}