= SH Spurをつかっての走行系の構築方法 本ページでは、SHSpurを用いての走行系の構築方法について説明していく予定です。 == 概要 SH-Spurを用いることで、様々な大きさ、速さの独立2輪駆動の移動ロボットの走行系を構築することができます。 ただし、現状では構築においていくつかハードウェアに依存する所があります。 具体的には * コントローラ - SH-2(Renesus SH7045) * 回転角検出 - 2相インクリメンタルロータリーエンコーダ(一周数百パルス程度、モータ軸直付け推奨) * モータ - DCモータ×２ * モータドライバ - 正逆転・PWM駆動（数ｋ～28kHz程度で）できるもの 等があげられます。 今後、対応するハードウェアを増やしこれらの制約を減らして行きたいと思いますが、 しばらくは上記の制約が付きます。 == 回路 === SH-2ボード SH-Spurは秋月電子通商製のAKI-SH2を想定して作られており、 現在は教育研究用ロボットbeegoのボードに対応しています。 今後その他のボードにも対応する予定です。 == パラメータの設定方法 === 基本パラメータ * PWM_MAX -- PWMの最大値です(28000000/設定値でPWM周波数が変更できます) * COUNT_REV -- エンコーダ分解能（4逓倍）(Counts/rev) * VOLT -- 電源電圧(V) * CYCLE -- 制御周期(s)(基本的には0.001で固定) === モータ関連パラメータ * GEAR -- ギア比(in/out回数) * MOTOR_R -- 巻き線抵抗(ohm) * MOTOR_TC -- トルク定数(Nm/A) * MOTOR_VC -- 回転数定数(rpm/V) * TORQUE_MAX -- モータ制限トルク(Nm) * TORQUE_NEWTON -- 静止摩擦補償量(Nm) * TORQUE_VISCOS -- 粘性摩擦補償量(Nm/(count/1ms)) * TORQUE_OFFSET -- 定常的に出すトルク(Nm) == 速度制御パラメータ * GAIN_KP -- PI制御の比例項 * GAIN_KI -- PI制御の積分項 * INTEGRAL_MAX -- 最大積分値 * GAIN_A-F 動特性保障用パラメータ（デフォルト値推奨） === 本体パラメータ * RADIUS_R -- 右タイヤ半径(m) * RADIUS_L -- 左タイヤ半径(m) * TREAD -- タイヤ間距離(m) * MASS -- 本体重量(kg) === 経路追従パラメータ * L_C1 -- * L_K1 -- * L_K2 -- * L_K3 -- * L_DIST -- === 制限パラメータ * MAX_VEL -- 最大速度(m/s) * MAX_W -- 最大回転角速度(rad/s) * MAX_ACC_V -- 最大加速度(m/ss) * MAX_ACC_W -- 最大回転角加速度(rad/ss) === param_tunerを用いたパラメータ設定
edit