yei

Dependencies:   interface mbed enc_1multi calPID motorout KondoServoLibrary

Fork of cat18_operate by Catch the GIANT Caplico!

Revision:
36:b8171eeefcd0
Parent:
35:f01c5dc7592f
Child:
37:d4b711619962
--- a/main.cpp	Wed Sep 05 02:51:27 2018 +0000
+++ b/main.cpp	Wed Sep 05 03:58:53 2018 +0000
@@ -47,8 +47,6 @@
         //3のときだけ特別に速度下げる
         if(worknum == 3) kServoVelocity_mm = 100;
         if(Go(shootingbox[boxspace]) != 0) continue;
-        pre_skip = 0;
-        do_skip = 0;
         __disable_irq();//割込み禁止
         ManualPutPlace(shootingbox[boxspace]);
         kServoVelocity_mm = 300;
@@ -56,9 +54,10 @@
         Open();
         wait_ms(1000);
         //上に持ち上げる
+        pre_skip = -1;
+        do_skip = 0;
         __enable_irq();//割込み許可
-        pre_skip = 0;
-        do_skip = 0;
+
         Above(BOX);
         wait_ms(kWait_ms);
         //置いたことを保存