yuya horie / Mbed 2 deprecated Roots

RobocupSSLのメイン基板白mbedのプログラム

Dependencies:   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は，ロボットとボールの座標，審判の判定を元にロボットの移動，キックなどの作戦を決定し，無線によってロボットに指令を送信する． 700

ロボット機能紹介

●オムニホイールによる方向転換不要の全方位移動

オムニホイールは，自由に回転可能なローラをホイールの外周上に配置した車輪である．ローラの回転により，車輪の回転と垂直の方向に駆動力を発することはできないが移動は可能となる．各車輪の角速度を調整することによって全方向への移動を可能にする．
400

●ドリブルバーのバックスピンによるボール保持

●電磁力を利用したキッカー

●キッカーの電磁力エネルギーを充電する充電回路

●ロボット情報が一目でわかるLCD

Diff: main.cpp

Revision:
33:13efae0ae6f4
Parent:
32:718efbf4dc8a
Child:
35:b1b00cfaa163
--- a/main.cpp	Sun May 06 02:17:10 2018 +0000
+++ b/main.cpp	Wed May 30 15:10:17 2018 +0000
@@ -28,9 +28,9 @@
     ParameterManager::machine_data.v_mm_per_sec = 0; //MAX:4m/s
     ParameterManager::machine_data.angle_degree = 0;
     ParameterManager::machine_data.vw_mrad_per_sec = 0; 
-//#ifndef ON_INDICATER
+#ifndef ON_INDICATER
     InterfaceManager::i2c.readIDMsg();
-//#endif    
+#endif    
     
     while(1) {
         if(StatusManager::ball == 1)
@@ -43,7 +43,8 @@
         }
         
         actmode.run();
-#if defined(MAIN_BORD_Ver_4) || defined(MAIN_BORD_Ver_5)          
+#if defined(MAIN_BORD_Ver_4) || defined(MAIN_BORD_Ver_5)
+        //StatusManager::motTrqData.MotTrq_short = (short)DribMot_Current.getLPF_Out( (double)InterfaceManager::batVoltage.read_u16()); //*(float)3.3 * 1000) ; //[mNm]          
         StatusManager::dribbleMotor_current = (float)DribMot_Current.getLPF_Out( ((double)InterfaceManager::dribbleMotor_current.read() - (double)0.4841) * (double)3.3 * (double)9.091 );
         //StatusManager::dribbleMotor_current = DribMot_Current.getLPF_Out( InterfaceManager::dribbleMotor_current.read());
         
@@ -65,10 +66,10 @@
            InterfaceManager::dribbleMotor.write((float)1.0 - StatusManager::req_dribbleMotor_PID  * (float)0.01 );
         }
 #endif
-        t.stop();
-        StatusManager::DriveTime = (short)t.read_us();
-        t.reset();
-        t.start();
+//        t.stop();
+//        StatusManager::DriveTime = (short)t.read_us();
+//        t.reset();
+//        t.start();
         
     }
 }