データ仕様

    データ名称ロータリーエンコーダ距離データ
    シンボルrot_count_r, rot_count_l
    データ種別
    データ構造最上位桁は符号を表す。
    その他は距離データ
    データ・タイプ符号付き
    データ・サイズ12ビットフィールド
    論理仕様負数は2の補数で表す。
    7BIT=0を正転、 =1を逆転とする
    rot_count_r 右車輪カウント値
    rot_count_l 左車輪カウント値
    初期値

    データ名称ロータリーエンコーダ計測データ右・左
    シンボルrot_measure_r, rot_measure_l
    データ種別
    データ構造最上位桁は符号を表す。
    rot_measure_r 駆動用右車輪角速度 [rad/sec]
    rot_measure_l 駆動用左車輪角速度 [rad/sec]
    その他はカウントデータ
    データ・タイプ符号付き整数型
    データ・サイズ4バイト
    論理仕様負数は2の補数で表す。
    7BIT=0を正転、 =1を逆転とする
    初期値

    データ名称ロータリーエンコーダによる位置・姿勢
    シンボルrot_self_x, rot_self_y, rot_self_th
    データ種別
    データ構造
    データ・タイプ符号付き整数型
    データ・サイズ4バイト
    論理仕様ロータリーエンコーダのカウントデータで求めた位置
    初期値スタート時競技場左角(進入禁止ゾーン手前)を原点とする。

    データ名称PWM制御データ右・左
    シンボルpwm_data_r, pwm_data_l
    データ種別
    データ構造pwm_data_r 右モーターの回転数
    pwm_data_l 左モーターの回転数制御データ
    データ・タイプ符号付き整数
    データ・サイズ1バイト
    論理仕様
    初期値

    データ名称赤外線センサ制御データ
    シンボルd_data
    データ種別下位2桁をデコーダに入力する値とする
    データ構造1ビット、0ビット=0、0 左赤外線4つを入力信号待ちとする
             =0、1 前方赤外線6つ 
             =1、0 右赤外線4つ
    データ・タイプ
    データ・サイズ2ビット
    論理仕様
    初期値00

    データ名称赤外線センサ感知データ
    シンボルs_data
    データ種別
    データ構造0ビット、右
    1ビット、↓ 
    2ビット、↓ 
    3ビット、↓ 
    4ビット、↓ 
    5ビット、左
    (1:ON,0:OFF)
    データ・タイプ整数型
    データ・サイズ6ビット
    論理仕様
    初期値

    データ名称赤外線センサ計測データ
    シンボルis_data
    データ種別
    データ構造7ビット、6ビット=赤外線デコーダに入力した値とする
    その他は感知データ
    データ・タイプ
    データ・サイズ1バイト
    論理仕様
    初期値00000000

    データ名称タッチセンサ感知データ
    シンボルts_input
    データ種別
    データ構造0ビット、左後ろタッチセンサの反応
    1ビット、左中タッチセンサ
    2ビット、左前タッチセンサ
    3ビット、右前タッチセンサ
    4ビット、右中タッチセンサ
    5ビット、右後ろタッチセンサ
    ON:1,OFF:0
    データ・タイプ
    データ・サイズ6ビット
    論理仕様
    初期値00000000

    データ名称超音波センサ距離データ
    シンボルus_input
    データ種別
    データ構造距離データ
    データ・タイプ
    データ・サイズ4バイトフィールド
    論理仕様超音波センサで測定した距離データ
    初期値

    データ名称超音波センサ計測データ
    シンボルus_length_r, us_length_f, us_length_l
    データ種別
    データ構造us_length_r 右方向距離 [cm]
    us_length_f 前方向距離 [cm]
    us_length_l 左方向距離 [cm]
    データ・タイプ整数型
    データ・サイズ4バイト
    論理仕様
    初期値

    データ名称自己位置補正データ
    シンボルc_pos_x,c_pos_y,c_pos_th
    データ種別
    データ構造補正データ
    データ・タイプ
    データ・サイズ1 byte
    論理仕様
    初期値

    データ名称自己位置・姿勢
    シンボルself_x, self_y, self_th
    データ種別
    データ構造位置データ・姿勢データ
    データ・タイプ符号付き整数型
    データ・サイズ4バイト
    論理仕様超音波の値を元に自己位置・姿勢データを格納する。
    姿勢角は、スタート時の向きを0とし、姿勢データ X 360/255=姿勢角[]
    初期値

    データ名称過去の自己位置
    シンボルold_s_pos_x, old_s_pos_y, old_s_pos_th 
    データ種別
    データ構造
    データ・タイプ符号付き整数型
    データ・サイズ4バイト
    論理仕様old_s_pos_x 過去x座標
    old_s_pos_y 過去y座標
    old_s_pos_th 過去姿勢角
    初期値

    データ名称7seg.LED灯火用データ
    シンボルmmi_display
    データ種別
    データ構造7segLEDに表示する4桁の10進数(0〜9999)がそのまま格納される.
    データ・タイプ無符号整数
    データ・サイズ2バイト
    論理仕様
    初期値

    データ名称単色LED灯火データ
    シンボルmmi_led
    データ種別
    データ構造・ビット0   赤色ダイオード(点灯:1,消灯:0)
    ・ビット1    緑色ダイオード(点灯:1,消灯:0)
    データ・タイプ無符号整数
    データ・サイズ2ビット
    論理仕様
    初期値

    データ名称PWM補正データ
    シンボルpwm_c_r,pwm_c_l
    データ種別
    データ構造7ビットは符号、その他は補正データ
    データ・タイプ
    データ・サイズ1 byte
    論理仕様
    初期値

    データ名称ロータリーエンコーダ積算カウンタリセット
    シンボルrot_rst
    データ種別
    データ構造リセット信号
    データ・タイプ
    データ・サイズ1 byte
    論理仕様
    初期値

    データ名称走行モード
    シンボルrun_mode
    データ種別
    データ構造
    データ・タイプ
    データ・サイズ1バイト
    論理仕様
    初期値

    データ名称競技モード
    シンボルmode
    データ種別
    データ構造
    データ・タイプ
    データ・サイズ1バイト
    論理仕様
    初期値

    データ名称速度データ
    シンボルself_v
    データ種別
    データ構造
    データ・タイプ符号付き整数型
    データ・サイズ4バイト
    論理仕様
    初期値

    バック