yuya horie
RobocupSSLのメイン基板白mbedのプログラム
Rootsロボット mainプログラム
~ Robocup SSL（小型車輪リーグ）ロボット ~
Robocup SSLとは
●試合構成
Robocup小型ロボットリーグ（Small Size League)は，直径180[mm]，高さ150[mm]以内のサイズのロボット6台が1チームとなり，オレンジ色のゴルフボールを使ってサッカー競技を行う自立型ロボットコンテストである.
フィールドの上には2台のWebカメラが設置され，フィールド上のロボットとボールを撮影する．Visionサーバは，フィールドの画像データよりロボットとボールの座標データを算出し，LANを用い各チームのAI用PCに送信する．Webカメラの撮影速度は，60[fps]である．レフリーボックスは，ファウルやフリーキック，スローインなどの審判の判定を入力し，LANを通じて各チームのAI用PCに送信する.それぞれのチームのAI用PCは，ロボットとボールの座標，審判の判定を元にロボットの移動，キックなどの作戦を決定し，無線によってロボットに指令を送信する．
ロボット機能紹介
●オムニホイールによる方向転換不要の全方位移動
オムニホイールは，自由に回転可能なローラをホイールの外周上に配置した車輪である．ローラの回転により，車輪の回転と垂直の方向に駆動力を発することはできないが移動は可能となる．各車輪の角速度を調整することによって全方向への移動を可能にする．
●ドリブルバーのバックスピンによるボール保持
●電磁力を利用したキッカー
●キッカーの電磁力エネルギーを充電する充電回路
●ロボット情報が一目でわかるLCD
Diff: interface/interface_manager.cpp
- Revision:
- 26:d626e7968063
- Parent:
- 25:15f75825fc36
- Child:
- 29:4607c59702a1
--- a/interface/interface_manager.cpp Sun Apr 29 08:51:32 2018 +0000
+++ b/interface/interface_manager.cpp Tue May 01 02:02:35 2018 +0000
@@ -6,7 +6,35 @@
CAN_Roots InterfaceManager::can;
Xbee_Roots InterfaceManager::xbee;
-#ifndef MAIN_BORD_Ver_5
+#ifdef MAIN_BORD_Ver_4
+DigitalOut InterfaceManager::straight_kick(D3);
+DigitalOut InterfaceManager::chip_kick(D6);
+DigitalOut InterfaceManager::charge_request(D1);
+DigitalOut InterfaceManager::LED(D11);
+//DigitalOut InterfaceManager::dribbleStandBy(A5);
+
+DigitalIn InterfaceManager::ball_sensor(A4);
+DigitalIn InterfaceManager::charge_completed(D0);//D0
+DigitalIn InterfaceManager::dribbleIC_fault(A6);
+
+PwmOut InterfaceManager::dribbleMotor(A5);
+AnalogIn InterfaceManager::dribbleMotor_current(A7);
+#elif MAIN_BORD_Ver_5
+DigitalOut InterfaceManager::straight_kick(D3);
+DigitalOut InterfaceManager::chip_kick(D6);
+DigitalOut InterfaceManager::charge_request(D0);
+DigitalOut InterfaceManager::LED(D11);
+//DigitalOut InterfaceManager::dribbleStandBy(A5);
+
+DigitalIn InterfaceManager::ball_sensor(A4);
+DigitalIn InterfaceManager::charge_completed(D1);//D0
+DigitalIn InterfaceManager::dribbleIC_fault(A7);
+
+PwmOut InterfaceManager::dribbleMotor(A5);
+AnalogIn InterfaceManager::dribbleMotor_current(A6);
+
+
+#else
DigitalOut InterfaceManager::straight_kick(D3);
DigitalOut InterfaceManager::chip_kick(D6);
DigitalOut InterfaceManager::charge_request(D1);
@@ -20,19 +48,6 @@
PwmOut InterfaceManager::dribbleMotor(A6);
//DigitalIn InterfaceManager::modeSW_1(A3);
//DigitalIn InterfaceManager::modeSW_2(A2);
-#else
-DigitalOut InterfaceManager::straight_kick(D3);
-DigitalOut InterfaceManager::chip_kick(D6);
-DigitalOut InterfaceManager::charge_request(D1);
-DigitalOut InterfaceManager::LED(D11);
-//DigitalOut InterfaceManager::dribbleStandBy(A5);
-
-DigitalIn InterfaceManager::ball_sensor(A4);
-DigitalIn InterfaceManager::charge_completed(D0);//D0
-DigitalIn InterfaceManager::dribbleIC_fault(A6);
-
-PwmOut InterfaceManager::dribbleMotor(A5);
-AnalogIn InterfaceManager::dribbleMotor_current(A7);
#endif
AnalogIn InterfaceManager::batVoltage(A0);
@@ -52,7 +67,7 @@
//InterfaceManager::dribbleStandBy = 0;
InterfaceManager::dribbleMotor.period_us(50);
-#ifdef MAIN_BORD_Ver_5
+#if defined(MAIN_BORD_Ver_4) || defined(MAIN_BORD_Ver_5)
InterfaceManager::dribbleMotor.write(1.0); //0.0~1.0
#else
InterfaceManager::dribbleMotor.write(0.0); //0.0~1.0