Michael Benedikt / Mbed 2 deprecated Bertl2_0

TurnBackMoveFrontIsNotClear

Dependencies:   mbed ur_Bertl

Bertl2_0.cpp

Committer:
zwiebelturm100
Date:
2015-05-08
Revision:
0:60330fba6e8d

File content as of revision 0:60330fba6e8d:

#include "mbed.h"
#include "ur_Bertl.h"
#include "Bertl2_0.h"

void Bertl2_0 :: TurnBackMoveFrontNotClear()
{   
    if( FrontIsClear() )
    { 
        Move();
    }
    else 
    {
        TurnLeft();
        TurnLeft();
        Move();
    }
}