Dependencies:   mbed ros_lib_kinetic

Fork of NHK_kaida_ros0322_4 by ROBOSTEP4期

Revision:
18:0184238dccc3
Parent:
17:df95c0fb7b87
Child:
19:06246ffe0235
--- a/main.cpp	Thu Mar 22 06:11:35 2018 +0000
+++ b/main.cpp	Thu Mar 22 06:36:35 2018 +0000
@@ -139,6 +139,18 @@
         }
     else if (act==7) {
         fuck=1;
+        s_grab=0;
+        wait(2);
+        ledw=1;
+        wait(1);
+        snap=0;
+        wait(waittime); 
+        grab=0;
+        wait(1);
+        ledw=0;
+        }
+    else if (act==8) {
+        fuck=1;
         s_grab2=0;
         wait(2);
         ledw=1;
@@ -149,27 +161,15 @@
         wait(1);
         ledw=0;
         }
-    else if (act==8) {
+    else if (act==9) {
         fuck=1;
-        s_grab=0;
+        s_grab2=0;
         wait(2);
         ledw=1;
         wait(1);
-        snap=0;
+        snap2=0;
         wait(waittime); 
-        grab=0;
-        wait(1);
-        ledw=0;
-        }
-    else if (act==9) {
-        fuck=1;
-        s_grab=0;
-        wait(2);
-        ledw=1;
-        wait(1);
-        snap=0;
-        wait(waittime); 
-        grab=0;
+        grab2=0;
         wait(1);
         ledw=0;
         }