für holdor

Dependencies:   Servo mbed pixy

Fork of PES by Gruppe 3

Revision:
7:edb4e0cfc0d1
Parent:
6:4af735d26b7a
Child:
8:6d9cd5ad332d
--- a/main.cpp	Tue Apr 11 14:53:18 2017 +0000
+++ b/main.cpp	Tue Apr 11 15:42:22 2017 +0000
@@ -21,7 +21,7 @@
 
 //Periphery for Switch ON/OFF
 
-DigitalIn swichtOnOFF (USER_BUTTON);
+DigitalIn switchOnOff(USER_BUTTON);
 
 //motor stuff
 DigitalOut enableMotorDriver(PB_2);
@@ -37,14 +37,14 @@
 {
     enable = 1;  // Sensoren einschalten
     enableMotorDriver = 1; // Schaltet die Motoren ein
-    pwmL->period(0.00005f); // Setzt die Periode auf 50 μs
-    pwmR->period(0.00005f);
+    pwmL.period(0.00005f); // Setzt die Periode auf 50 μs
+    pwmR.period(0.00005f);
 
-    int state = 0; // Diese Variable gibt an in welchem State man sich befindet
+    int state = 1; // Diese Variable gibt an in welchem State man sich befindet
 
-    if ( kamera() == 1) {
+    /*if ( kamera() == 1) {
         state = 4;
-        ) // Die Kamera erkennt ein grünen Klotz
+        } // Die Kamera erkennt ein grünen Klotz*/
         while(1) {
 
         switch(state) {
@@ -54,9 +54,7 @@
                     if (switchOnOff == 1) {
                         state = 2;
                     }
-                    if (swichtOnOff ==0) {
-                        state =1;
-                    }
+
                     break;
 
                 case 2:
@@ -93,19 +91,16 @@
 
                 case 4: // Roboter erkennt gründer Klotz, Klotz wird angefahren
 
-                    ...
+                    
                     break;
 
                 case 5: // Aufnehmen des Klotzes
 
 
-                    .....
+                    
                     break;
 
-
-                default
-
-                        ... break ;
+                    
             }
 
             wait(0.1f);