Fährt und zählt bis Taster (vorne mitte) feuert, gibt dann aus und dreht nach links

Dependencies:   mbed ur_Bertl

main.cpp

Committer:
SebiStr99
Date:
2015-05-08
Revision:
5:306ce06a8b20
Parent:
4:d66cee2c040e

File content as of revision 5:306ce06a8b20:

#include "mbed.h"
#include "ur_Bertl.h"
#include "Beeper_Bertl.h"

Serial bt(p9, p10);

void main()
{
    Bertl karel;
    
    int Beeper = 0;
    int moves = 0;
    
    while(1)
    {
        bool stFront = 0;
        
        while(!karel.IsButtonPressed(BTN_FM))
        {
            stFront = 1;
            karel.Move(50);
            moves++;
            if(karel.NextToABeeper())
            {
                Beeper++;
                //bt.printf("%i. Beeper", Beeper);
                karel.Move(50);
                moves++;            
            }
            while(karel.NextToABeeper() && !karel.IsButtonPressed(BTN_FM))
            {
                karel.Move(50);
                moves++;    
            }
        }
        
        if(stFront == 1)
        {
            wait_ms(500);
            bt.printf("\nGesamt: Moves: %i; Beeper: %i", moves, Beeper);
            karel.TurnLeft();
        }
    }    
}