Janus Bo Andersen / Mbed 2 deprecated T2PRO1_master

Dependencies:   mbed m3pi

Revision:
14:408d9d087d0f
Parent:
13:6a8689f601cd
Child:
15:fd6886ab896a
--- a/main.cpp	Thu Nov 29 12:24:51 2018 +0000
+++ b/main.cpp	Thu Nov 29 12:35:48 2018 +0000
@@ -33,11 +33,18 @@
 {
     
     return 1;
-}       
+}   
+
+void turn_left (void)
+{
+    m3pi.left(0.3);
+    wait (0.22);
+}
+    
 void turn_right (void)
 {
     m3pi.right (0.3);
-    wait (0.2);
+    wait (0.22);
 }
 
 int main() {
@@ -103,7 +110,12 @@
                 turn_right();
                 m3pi.stop();
                 m3pi.forward(0.2);
-                wait (0.5);
+                wait (2);
+                m3pi.stop();
+                m3pi.backward(0.2);
+                wait (2);
+                m3pi.stop();
+                turn_left();
                 m3pi.stop();
             }
         /*