yei

Dependencies:   interface mbed enc_1multi calPID motorout KondoServoLibrary

Fork of cat18_operate by Catch the GIANT Caplico!

Revision:
4:187c62291654
Parent:
3:05b1dcb3634e
Child:
5:af5ccfce1b90
diff -r 05b1dcb3634e -r 187c62291654 main.cpp
--- a/main.cpp	Mon Aug 06 04:30:05 2018 +0000
+++ b/main.cpp	Thu Aug 09 05:37:04 2018 +0000
@@ -10,27 +10,34 @@
 ///setup関連を集めた
 void Setups();
 void Tests();
-//const int kWorkNum = 12;//ワークの数
 
 int main()
 {
     DEBUG("setup start\r\n");
     Setups();
+    //スタート指示受付
     while(CanStart() == 0){};
     DEBUG("main start");
-    while(1) {
-        int worknum = CalPickPlace();//目標ワーク計算
-        //ワークのところまで行く。腕も準備
+    int worknum = 0;
+    while( (worknum = CalPickPlace()) != 23 ) {
+        //ワークに向かう
         if(Go(work[worknum]) != 0) continue;
+        //掴む
         Close();
+        //上に持ち上げる
         Above();
+        //取り上げたことを保存
         work[worknum].is_exist = 0;
-        int boxspace = CalPutPlace(work[worknum].color);//シュート位置計算
+        //シュート位置計算
+        int boxspace = CalPutPlace(work[worknum].color);
         //ボックスに行く(失敗(-1)したらcontinue)
         if(Go(shootingbox[boxspace]) != 0) continue;
+        //放す
         Open();
+        //上に持ち上げる
         Above();
-        shootingbox[boxspace].is_exist = 1;//置いたことを保存
+        //置いたことを保存
+        shootingbox[boxspace].is_exist = 1;
         shootingbox[boxspace].color = work[worknum].color;
     }
 }