a

Dependencies:   Servo ServoArm mbed

Fork of PES_Official-TestF by zhaw_st16b_pes2_10

Revision:
13:6c1f8e35b242
Parent:
12:c0bcb95885dd
Child:
14:b61fbd13a7c9
--- a/Sources/main.cpp	Wed May 10 13:30:13 2017 +0000
+++ b/Sources/main.cpp	Wed May 10 16:53:01 2017 +0000
@@ -63,7 +63,7 @@
 
     enum states { search = 0, forward, downward, down, upward, color, backwardDrop, readyDrop, backward };
 
-    int state = downward;
+    int state = search;
 
     while( 1 ) {
         
@@ -73,7 +73,7 @@
         
         switch( state ) {
             case search:
-                if( sam.search(&timer) ){
+                if( 1 || sam.search(&timer) ){
                   state = forward;
                   timer = 0;
                 }
@@ -157,7 +157,7 @@
                 
             case backward:
                 if( sam.Arm.collectToBack() ){
-                    state = downward;
+                    state = search;
                     timer = 0;
                 }