für holdor

Dependencies:   Servo mbed pixy

Fork of PES by Gruppe 3

Revision:
18:ea4671f566d4
Parent:
17:caf5ae550f2e
--- a/main.cpp	Tue Apr 25 12:26:04 2017 +0000
+++ b/main.cpp	Tue Apr 25 13:44:12 2017 +0000
@@ -74,7 +74,7 @@
 
             case 2:
                 printf("2");
-                if(time1 < 20) {       // Im Kreis drehen für 1s
+                if(time1 < 15) {       // Im Kreis drehen für 1s
                     pwmL = 0.4f;
                     pwmR = 0.4f;
                     time1 ++;
@@ -92,7 +92,7 @@
             case 3:
                 printf("3");
                 roboter1.bandeAusweichen();
-                if(time2 < 40) {    // gerade aus fahren
+                if(time2 < 100) {    // gerade aus fahren
                     pwmL = 0.6f;
                     pwmR = 0.4f;
                     time2 ++;
@@ -111,16 +111,19 @@
                 printf("4");
                 roboter1.bandeAusweichen();
                 if(camValue == 1) {     // links fahren
-                    pwmL = 0.45f;
-                    pwmR = 0.45f;
+                    printf(".1;");
+                    pwmL = 0.425f;
+                    pwmR = 0.425f;
                 }
                 if(camValue == 2) {     // rechts fahren
-                    pwmL = 0.55f;
-                    pwmR = 0.55f;
+                    printf(".2;");
+                    pwmL = 0.575f;
+                    pwmR = 0.575f;
                 }
                 if(camValue == 3) {     // gerade fahren
-                    pwmL = 0.55f;
-                    pwmR = 0.45f;
+                    printf(".3;");
+                    pwmL = 0.6f;
+                    pwmR = 0.4f;
                 }
                 state = 1;