Michael Benedikt
/
Bertl2_0
TurnBackMoveFrontIsNotClear
Diff: Bertl2_0.cpp
- Revision:
- 0:60330fba6e8d
diff -r 000000000000 -r 60330fba6e8d Bertl2_0.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Bertl2_0.cpp Fri May 08 08:15:19 2015 +0000 @@ -0,0 +1,17 @@ +#include "mbed.h" +#include "ur_Bertl.h" +#include "Bertl2_0.h" + +void Bertl2_0 :: TurnBackMoveFrontNotClear() +{ + if( FrontIsClear() ) + { + Move(); + } + else + { + TurnLeft(); + TurnLeft(); + Move(); + } +} \ No newline at end of file