yei
Dependencies: interface mbed enc_1multi calPID motorout KondoServoLibrary
Fork of cat18_operate by
Diff: main.cpp
- 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; } }