射出(3/29用)

Dependencies:   mbed ros_lib_kinetic

Fork of NHK_kaida_ros0322_4 by ROBOSTEP4期

Revision:
13:84f136900461
Parent:
12:6832bc92272f
Child:
14:3858894d1a6b
--- a/main.cpp	Thu Mar 15 05:07:54 2018 +0000
+++ b/main.cpp	Thu Mar 15 05:10:46 2018 +0000
@@ -253,12 +253,11 @@
                     led2=1;
                     led3=0;
                     led4=0;
-                    //wait(1.5);//桃井escape    
+                    fack=1;
+                    wait(2);//桃井escape    
                     grab=1;
                     //wait(1);
                     s_grab=1;
-                    wait(1);
-                    fack=1;
                 
                 } 
                 else if(ball_judgement==2){ 
@@ -266,27 +265,25 @@
                     led2=0;
                     led3=1;
                     led4=0;
-                    //wait(1.5);//桃井escape
+                    fack2=1;
+                    wait(2);//桃井escape
                     grab2=1;
                     //wait(1);
                     s_grab2=1;
-                    wait(1);
-                    fack2=1;
                 }
                 else if(ball_judgement==3){ 
                     led1=0;
                     led2=0;
                     led3=0;
                     led4=1;
-                    //wait(1.5);//桃井escape
+                    fack=1;
+                    fack2=1;
+                    wait(2);//桃井escape
                     grab=1;
                     grab2=1;
                     //wait(1);
                     s_grab=1;
                     s_grab2=1;
-                    wait(1);
-                    fack=1;
-                    fack2=1;
                 }
                 else{
                     led1=1;