für holdor

Dependencies:   Servo mbed pixy

Fork of PES by Gruppe 3

Revision:
8:6d9cd5ad332d
Parent:
7:edb4e0cfc0d1
Child:
9:d9e46f9c9e40
--- a/main.cpp	Tue Apr 11 15:42:22 2017 +0000
+++ b/main.cpp	Tue Apr 18 12:09:46 2017 +0000
@@ -39,6 +39,9 @@
     enableMotorDriver = 1; // Schaltet die Motoren ein
     pwmL.period(0.00005f); // Setzt die Periode auf 50 μs
     pwmR.period(0.00005f);
+    pwmL = 0.5f;
+    pwmR = 0.5f; 
+   
 
     int state = 1; // Diese Variable gibt an in welchem State man sich befindet
 
@@ -51,8 +54,8 @@
 
                 case 1: // Roboter Anschalten mit Knopf
 
-                    if (switchOnOff == 1) {
-                        state = 2;
+                    if (switchOnOff== 0){
+                        state = 5;
                     }
 
                     break;
@@ -96,9 +99,12 @@
 
                 case 5: // Aufnehmen des Klotzes
 
-
+ roboter1.bandeAusweichen();
                     
                     break;
+                    
+                    
+                default: break;  
 
                     
             }