タスク構成

  1. 初期設定タスク

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

  2. 自己位置認識タスク

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

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

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

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

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

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

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

  6. MMI制御タスク

     行動計画タスクで7SegLEDの表示内容の変更があったとき起動する。変更7SegLEDの表示内容を更新する.4桁のうち最上位桁は、下位3桁の表示内容を示すIDでIDは0から9までの数値でMMIの押しボタン割り込みによりカウントアップされる.

  7. 行動計画タスク

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

  8. 走行制御タスク

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

  9. 自己位置補正タスク

     タイマ割り込みにより起動される.左右の超音波センサの測定したデータに基づき,左右方向(XかYかはMIRSの姿勢及び現在位置により決定する)を補正する.タイマ割り込み間隔については,総合試験で決定する.

  10. リモートコントロールタスク

     ロータリースイッチによって初期設定タスクにより起動される。BBに掲示された情報に基づき,RS−232Cポートを使用してデータの送受信を行う.送受信のタイミングは,総合試験計画で決定する.



データ一覧
BB一覧
初期設定タスクBB初期化データRE初期化データPWM初期化データ赤外線初期化データ超音波初期化データLED競技モード
自己位置認識タスクBBロータリーエンコーダー距離データロータリーエンコーダー計測データ右ロータリーエンコーダー計測データ左ロータリーエンコーダーによるx座標ロータリーエンコーダーによるy座標ロータリーエンコーダーによる姿勢角過去の自己位置x座標過去の自己位置y座標過去の自己位置姿勢角
超音波センサ制御タスクBB超音波センサ計測データ超音波センサ前計測データ
赤外線センサ制御タスクBB赤外線センサ感知データ赤外線センサ計測データ
タッチセンサ制御タスクBBタッチセンサ感知データ
MMI制御タスクBB7seg.LED表示データ単色LED点灯データ
行動計画タスクBBPWM制御データ右PWM制御データ左走行モードセンサモードデータ軌道データ
走行制御タスクBB速度データ
自己位置補正タスクBB自己位置補正データx座標自己位置補正データy座標 自己位置補正データ姿勢角自己位置x座標自己位置y座標自己位置姿勢角
リモートコントロールタスクBB
 ← BACK

Last Update : 1998/06/26 Written by T.Miyazaki.