Diff: main.cpp

Revision:

16:c5b864804632

Parent:

14:2926932e26df

Child:

17:8a8758bfe3c5

--- a/main.cpp	Fri May 04 20:36:38 2018 +0000
+++ b/main.cpp	Mon May 07 14:03:36 2018 +0000
@@ -38,6 +38,8 @@
     IRSensor irSensorC (distance4);
     IRSensor irSensorR (distance1);
     IRSensor irSensorB (distance3);
+    
+    Timer t1;
 
 //Motors:
     DigitalOut myled(LED1);
@@ -363,10 +365,14 @@
                 motion.rotate180();
                 printf("Sackgasse Schritt: %d\n", r);
                 r--;
+                t1.reset();
+                t1.start();
+                while (t1 < 2.0f) {}
+                t1.stop();
                 //Return to last junction
                 while (junction[j] <= r ) {
                 //for (int i = r; i >= junction[j]; i--
-            
+                    
                     if (junction[j] == r) {
                     
                         switch (route[r]) {