yuto kawamura / Mbed 2 deprecated cat18_operate_last

yei

Dependencies:   interface mbed enc_1multi calPID motorout KondoServoLibrary

Fork of cat18_operate by Catch the GIANT Caplico!

Diff: main.cpp

Revision:
29:ea48140fc85e
Parent:
28:bcfc84b481bc
Child:
30:af136b83b202
diff -r bcfc84b481bc -r ea48140fc85e main.cpp
--- a/main.cpp	Tue Sep 04 12:00:39 2018 +0000
+++ b/main.cpp	Tue Sep 04 12:53:50 2018 +0000
@@ -16,7 +16,7 @@
 int main()
 {
     GoSetup();
-    StartCheck();
+    GoToFirstPosition();
     SetupPosition();
     if(PositionSetupIsInBan() == 1) return 1;//失敗したら強制終了
     
@@ -34,8 +34,9 @@
         //ワークに向かう
         if(Go(work[worknum]) != 0) continue;
         #ifdef DEBUGMODE
+        DEBUG("ManualModeWithPc start\r\n");
         while(ManualModeWithPc() == 0){};
-        DEBUG("work %d %f, %f, %f\r\n", worknum, GetNowTipLocateX(), GetNowTipLocateY(), GetNowTipLocateZ());
+        DEBUG("ManualModeWithPc return work %d %f, %f, %f\r\n", worknum, GetNowTipLocateX(), GetNowTipLocateY(), GetNowTipLocateZ());
         #endif
         //掴む
         wait_ms(kWait_ms);