Diff: servo/servo.cpp

Revision:

16:b2358fd35999

Parent:

13:126c3f7f9b89

Child:

18:05f5a3323bda

diff -r 7881a35ba47f -r b2358fd35999 servo/servo.cpp
--- a/servo/servo.cpp	Tue Aug 14 01:20:40 2018 +0000
+++ b/servo/servo.cpp	Tue Aug 14 09:16:55 2018 +0000
@@ -15,7 +15,7 @@
 
 
 const int kServoSign[] = {-1, -1, -1, 1};//サーボの正負と座標系の正負の補正
-const int kServoSpan_ms = 2; //指示の前後に必要なwait
+const int kServoSpan_ms = 3; //指示の前後に必要なwait
 
 void Open();
 void Move(double x, double y, double theta);
@@ -39,9 +39,11 @@
         case COMMONAREA:
         case WORKAREA:
             Open();
+            DEBUG("open\r\n");
             break;
         case BOX:
             Close();
+            DEBUG("close\r\n");
             break;
     }
     return 1;
@@ -50,8 +52,12 @@
 void Open()
 {
     servo.set_degree(4,203.61375);
+    DEBUG("open real\r\n");
+    //wait(1);
 }
 void Close()
 {
     servo.set_degree(4,124.63875);
+    DEBUG("close real\r\n");
+    //wait(1);
 }
\ No newline at end of file