Michael Benedikt / Mbed 2 deprecated Bertl2_0

TurnBackMoveFrontIsNotClear

Dependencies:   mbed ur_Bertl

Diff: Bertl2_0.cpp

Revision:
0:60330fba6e8d
--- /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