データ仕様


BB一覧
10 11 12
00初期設定タスク 競技モード
−−−
初期化データRE 初期化データPWM 初期化データ赤外線 初期化データ超音波 初期化データLED
01自己位置認識・LQIタスク ロータリーエンコーダー距離データ ロータリーエンコーダー計測データ右 ロータリーエンコーダー計測データ左 自己位置x座標 自己位置y座標 自己位置姿勢角 過去の自己位置x座標 過去の自己位置y座標 過去の自己位置姿勢角 速度データ 角速度
02超音波センサ制御タスク 超音波センサ計測データ1 超音波センサ計測データ2 超音波センサ計測データ3 超音波センサ計測データ4 超音波センサ計測データ5 超音波センサ計測データ6 超音波センサ前計測データ1 超音波センサ前計測データ2 超音波センサ前計測データ3 超音波センサ前計測データ4 超音波センサ前計測データ5 超音波センサ前計測データ6
03赤外線センサ制御タスク 赤外線センサ感知データ 赤外線センサ計測データ 赤外線見失い位置x 赤外線見失い位置y 赤外線見失い姿勢角 赤外線センサ反応番号
04タッチセンサ制御タスク タッチセンサ感知データ
05MMI制御タスク 7seg.LED表示データ 単色LED点灯データ 敵発見フラグ
06行動計画タスク PWM制御データ右 PWM制御データ左 走行モード センサモードデータ 軌道データ 相手位置x 相手位置y 走行状態データ
07走行制御タスク 目標速度 目標値姿勢角 制御フラグ 到達フラグ
08テスト用タスク 自己座標補正(x軸) 自己座標補正(y軸) 自己姿勢角補正(th)

データ名ロータリーエンコーダー距離データ
シンボルre_dist
サイズ1 byte
種別自己位置認識タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
符号        距離データ
論理仕様負数は,2の補数で表す
7bit=0を正転,=1を逆転とす
初期値
備考

データ名ロータリーエンコーダー計測データ
シンボルre_r 、 re_l
サイズ1 byte
種別自己位置認識タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
符号        カウントデータ
論理仕様負数は,2の補数で表す
7bit=0を正転,=1を逆転とす
初期値
備考

データ名ロータリーエンコーダーによる位置・姿勢
シンボルre_x 、 re_y 、 re_th
サイズ1 byte
種別自己位置認識タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
位置データ又は、姿勢データ
論理仕様スタート時競技場左角(フェンス)を原点として,
ロータリーエンコーダーのカウントデータで
求めた位置
1[cm]= 1h
200[cm]=C8h
初期値
備考

データ名PWM制御データ右・左
シンボルpwm_r 、 pwm_l
サイズ1 byte
種別走行制御タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
制御データ
論理仕様PWMに与えるデューティー比
デューティー比=制御データ×50%
00h〜127h
初期値
備考

データ名赤外線センサ感知データ
シンボルir_data
サイズ1 byte
種別赤外線センサ制御タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
左 −−−−−−> 右
論理仕様”1”反応
”0”無反応
初期値
備考

データ名赤外線センサ計測データ
シンボルir_cnt
サイズ2 bytes
種別赤外線センサ制御タスク(BB)
データ構成 15 〜 0 
反応
論理仕様”1”反応
”0”無反応
初期値
備考

データ名赤外線センサ反応番号
シンボルir_num
サイズ1 byte
種別赤外線センサ制御タスク(BB)
データ構成
 7 〜 0 
反応番号
論理仕様
初期値
備考

データ名タッチセンサ感知データ
シンボルta_data
サイズ3 bits
種別タッチセンサ制御タスク(BB)
データ構成 2  1  0 
左  右  前
論理仕様”1”反応
”0”無反応
初期値
備考

データ名超音波センサ距離データ
シンボルuss_dist
サイズ1 byte
種別超音波センサ制御タスク
データ構成 7  6  5  4  3  2  1  0 
距離データ
論理仕様超音波センサで測定した距離データ
00h=0[cm]
01h=1[cm]
初期値
備考

超音波センサ制御タスク
データ名超音波センサ選択データ
シンボルuss_s
サイズ2 bits
種別
データ構成 1  0 
論理仕様  3   2   1   0
前右 前左 右前 左前 (前・平等モード)
左後 右後 右前 左前 (左モード)
前右 前左 右前 左前 (右モード)
初期値
備考

データ名超音波センサ計測データ
シンボルuss_cnt[x]
サイズ1 byte
種別超音波センサ制御タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
計測データ
論理仕様x=5:左後
x=4:前右
x=3:右後
x=2:前左
x=1:右前
x=0:左前
初期値
備考

データ名超音波センサ前計測データ
シンボルuss_old_cnt[x]
サイズ1 byte
種別超音波センサ制御タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
計測データ
論理仕様前回計測されたデータが格納される
x=5:左後
x=4:前右
x=3:右後
x=2:前左
x=1:右前
x=0:左前
初期値
備考

データ名目標値(速度、姿勢角)
シンボルc_pos_v 、c_pos_th
サイズ2 byte
種別走行制御タスク(BB)
データ構成 15 〜 0 
目標値データ
論理仕様
初期値
備考

データ名自己位置・姿勢
シンボルself_x 、 self_y 、self_th
サイズ2 bytes
種別自己位置認識タスク(BB)
データ構成 15 〜 0 
位置データ・姿勢データ
論理仕様自己位置・姿勢データが格納される
姿勢角は、スタート時の右後ろの角を原点とし、前方をy軸、右をx軸とする。
初期値
備考

データ名過去の自己位置
シンボルold_s_x 、 old_s_y 、old_s_th
サイズ1 byte
種別自己位置認識タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
位置データ・姿勢データ
論理仕様
初期値
備考

データ名速度データ
シンボルself_v
サイズ1 byte
種別走行制御タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
符号        速度データ
論理仕様
初期値
備考

データ名相手位置
シンボルenemy_x 、 enemy_y
サイズ1 byte
種別行動計画タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
位置データ
論理仕様向き:01=右、10=左、00=前
初期値
備考

データ名初期化データ
シンボルre_clr 、 pwm_clr 、 ir_clr 、 uss_clr 、 led_clr
サイズ1 byte
種別初期設定タスク(BB)
データ構成 7  6  5  4  3  2  1  0 
       初期化データ
論理仕様
初期値
備考

データ名7seg.LED表示データ
シンボルdisp_7seg[n] (n:0-3)
サイズ1 byte
種別MMI制御タスク
データ構成 7  6  5  4  3  2  1  0 
表示データ
論理仕様
初期値
備考

データ名単色LED点灯データ
シンボルdisp_led
サイズ2 bits
種別MMI制御タスク
データ構成
 1  0 
緑 赤
論理仕様1=点灯
初期値
備考

データ名競技モード
シンボルmode
サイズ2 bits
種別初期設定タスク(BB)
データ構成  1  0 
モード
論理仕様0:競技、1:ペナルティ、2:リモートコントロール
初期値
備考

データ名走行モード
シンボルrun_mode
サイズ3 bits
種別行動計画タスク(BB)
データ構成 3  1  0 
モード
論理仕様0:探索準備 1:探索 2:超音波追跡
 3:赤外線追跡 4:回避
初期値
備考

データ名PWM補正データ
シンボルpwm_c_r 、 pwm_c_l
サイズ1 byte
種別走行制御タスク
データ構成 7  6  5  4  3  2  1  0 
符号           補正データ
論理仕様
初期値
備考

データ名ロータリーエンコーダ積算カウンタリセット
シンボルre_rst
サイズ12 bits
種別自己位置認識タスク
データ構成 11  10  9  8  7  6  5  4  3  2  1  0 
リセット信号
論理仕様
初期値
備考

データ名センサモードデータ
シンボルse_mode
サイズ2 bits
種別行動計画タスク(BB)
データ構成
 1  0 
センサモードデータ
論理仕様00=前モード、01=左モード
10=右モード、11=平等モード
初期値
備考

データ名軌道データ
シンボルrun_way
サイズ2 bits
種別行動計画タスク(BB)
データ構成
 1  0 
軌道データ
論理仕様00=直線、01=回転
10=円軌道
初期値
備考

データ名スタートスイッチデータ
シンボルstart_swich
サイズ2 bits
種別初期設定タスク(BB)
データ構成
 1  0 
軌道データ
論理仕様00=押されていない、01=押された
10=タスクを起動した
初期値
備考

データ名到達フラグ
シンボルattain
サイズ1 bit
種別走行制御タスク(BB)
データ構成
 0 
論理仕様0=移動中、1=目的地についた
初期値
備考

データ名敵発見フラグ
シンボルfinding
サイズ1 bit
種別MMI制御タスク(BB)
データ構成
 0 
論理仕様1=敵発見
初期値
備考

データ名赤外線見失い位置
シンボルir_non_x , ir_non_y , ir_non_th
サイズ1 byte
種別赤外線制御タスク(BB)
データ構成
 7  6  5  4  3  2  1  0 
論理仕様角度はその位置からの赤外線発信地の向きをとる
初期値
備考

データ名走行状態データ
シンボルrun_mode_state
サイズ1 byte
種別行動計画タスク(BB)
データ構成
 7  6  5  4  3  2  1  0 
論理仕様0:回転準備、1:回転中、2:直進準備、3:直進中
初期値
備考

データ名角速度
シンボルw
サイズ1 byte
種別自己位置認識タスク(BB)
データ構成
 7  6  5  4  3  2  1  0 
論理仕様単位[cdeg/s]
初期値
備考


  ← BACK

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