PES2_R2D2.0 / Mbed 2 deprecated MicroMouse_MASTER_FOUR

Pathfinding nach rechts funktioniert noch nicht...der rest schon

Dependencies:   mbed

Fork of MicroMouse_MASTER_THREE by PES2_R2D2.0

Diff: Turn.cpp

Revision:
6:a09d2ee3b82e
Parent:
5:b8b1a979b0d5
Child:
7:5ef09519a6e9
--- a/Turn.cpp	Wed Apr 25 12:07:03 2018 +0000
+++ b/Turn.cpp	Wed Apr 25 12:49:48 2018 +0000
@@ -39,8 +39,8 @@
         //printf("%d\n\r", countsRight);
         //printf("%d\n\r", countsLeft);
     }
-    controller.setDesiredSpeedRight(0.0f);
-    controller.setDesiredSpeedLeft(0.0f);
+    controller.setDesiredSpeedRight(0.5f);
+    controller.setDesiredSpeedLeft(0.5f);
     
     }else if (wallFront == 0){ //Nicht Drehen-> weiter Geradeaus
     
@@ -58,8 +58,8 @@
                 //printf("%d\n", countsRight);
                 //printf("%d\n", countsLeft);
             }
-            controller.setDesiredSpeedRight(0.0f);
-            controller.setDesiredSpeedLeft(0.0f);
+            controller.setDesiredSpeedRight(0.5f);
+            controller.setDesiredSpeedLeft(0.5f);
             
             
             }else{ //Alle Wege versperrt-> Wenden
@@ -74,7 +74,7 @@
                     //printf("%d\n", countsRight);
                     //printf("%d\n", countsLeft);
                 }
-                controller.setDesiredSpeedRight(0.0f);
-                controller.setDesiredSpeedLeft(0.0f);
+                controller.setDesiredSpeedRight(0.5f);  //0.0f
+                controller.setDesiredSpeedLeft(0.5f);   //0.0f
             }
 }