yei
Dependencies: interface mbed enc_1multi calPID motorout KondoServoLibrary
Fork of cat18_operate by
Diff: servo/servo.cpp
- Revision:
- 16:b2358fd35999
- Parent:
- 13:126c3f7f9b89
- Child:
- 18:05f5a3323bda
--- 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