Algorithmus

Dependencies:   mbed

Revision:
17:8a8758bfe3c5
Parent:
16:c5b864804632
Child:
18:3309329d5f42
--- a/main.cpp	Mon May 07 14:03:36 2018 +0000
+++ b/main.cpp	Mon May 07 18:28:34 2018 +0000
@@ -367,7 +367,7 @@
                 r--;
                 t1.reset();
                 t1.start();
-                while (t1 < 2.0f) {}
+                while (t1 < 0.5f) {}
                 t1.stop();
                 //Return to last junction
                 while (junction[j] <= r ) {
@@ -388,6 +388,11 @@
                                 r--;
                                 break;
                         }
+                        motion.stop();
+                        t1.reset();
+                        t1.start();
+                        while (t1 < 1.0f) {}
+                        t1.stop();
                 
                     }else{
                         //invert rotation