タスク構成

  1. 初期設定タスク

    電源投入時またはリセットボタン押下時に一回だけ起動され,処理終了後行動計画タスクを起動する.初期診断プログラムの実行,ハードウェアの初期設定,自己位置を競技開始位置に設定, タスクの初期化,掲示板(BB)の初期化を行う. また,ロータリースイッチを読み込み,動作モードをBBに書き込む.DIPの状態によっては,リモートタスクを起動する.

  2. 自己位置認識・LQI制御タスク

     タイマ割り込みにより起動される.ロータリエンコーダのカウント値を読み込み,自己位置(X,Y,Θ:姿勢角)を計算しBBに格納する.処理終了後,次のタイマ割り込みを設定する.また,LED表示モードがX,Y,Θのいずれかであれば7SegLED表示タスクを起動する.(7SegLED表示タスク用のBBを参照することにより何を表示しているか知ることができる).タイマ割り込み間隔については,総合試験で決定するが,総合試験版では50msに設定する。  また、このタスクで自機の速度と姿勢角を制御する。(LQI制御)

  3. 超音波センサ制御タスク

     タイマ割り込みにより起動される.4つの超音波センサにより順次距離を測定し結果をBBに格納する.処理終了後,次のタイマ割り込みを設定する.LED表示モードが超 音波センサ状態を示していれば,7SegLED表示タスクを起動 する.また,左右の超音波センサの計測距離の和が(2m− 左右センサ間隔)であれば,自己位置補正タスクを起動する.タイマ割り込み間隔については,総合試験で決定するが,総合試験版では,100msに設定する.

  4. 赤外線センサ制御タスク

     赤外線センサのハードウェア割り込みにより起動され,赤外線センサの状態をBBに書き込む.その計測データにより敵機を追跡する。LED表示モードが赤外線センサ状態を示していれば7SegLED表示タスクを起動する.

  5. タッチセンサ制御タスク

     タッチセンサのハードウェア割り込みにより起動される。左右のタッチセンサの反応により回避行動に移る。

  6. MMI制御タスク

     行動計画タスクで7SegLEDの表示内容の変更があったとき起動する。現在の自機の状態をLEDを使い表現する。

  7. 行動計画タスク

     初期設定タスク終了後起動。BBに掲示された情報に基づき,MIRSの行動を決定する.このタスクより走行制御タスクが起動される.

  8. 走行制御タスク

     行動計画タスクから起動される.起動時に軌跡と目標位置が与えられる.起動後,BBに実行中コードを書き込み,目標位置に到達するまでタイマ割り込みにより0.05秒毎に最起動され与えられた軌道に対する差を補正しながら移動する.目標位置に到達したときは実行完了コードをBBに書き込む.実行中に実行を強制停止する機能を有する.



データ一覧
 ← BACK

Last Update : 1998/01/20 Written by T.Hasegawa.
Update : 1998/01/19 Written by T.Miyazaki.
Update : 1998/06/26 Written by T.Miyazaki.