Skip to content

ファームウェアと通信仕様

各モジュールのファームウェアは、CANバスを介した指令に基づいて動作します。 ここでは各モジュールが使用するCAN IDと制御の仕様について解説します。

CAN IDマップ

PCとモジュール間の通信には以下のCAN IDが割り当てられています。

CAN ID 送信元 送信先 役割
0x100 PC Servo 6チャンネル分の角度指令
0x200~0x203 PC MDD モータ1から4のPIDパラメータ設定
0x210 PC MDD 4チャンネル分のモード設定
0x220 PC MDD 4チャンネル分の目標値指令
0x230 MDD PC リミットスイッチやエラーなどのステータス返信
0x240 MDD PC エンコーダの角度データ返信
0x250 MDD PC エンコーダの回転速度データ返信
0x300 PC Solenoid Valve 12チャンネル分の電磁弁オンオフ指令

これらのベースIDはファームウェアに書き込まれていますが、ツール側から設定を変更することで同じ種類のモジュールを複数同時に使用することも可能です。

MDDモジュールの制御仕様

MDDモジュールは起動直後にパラメータ設定モードになります。 PCからPIDゲインやモードのパラメータを受信し終えると制御実行モードへ移行します。 制御実行モード中は1ミリ秒周期でエンコーダの値を読み取り、指定されたモードに合わせてPID計算を行いモータを出力します。 ステータスやエンコーダの値は10ミリ秒周期でPCへ送信し続けます。

Servoモジュールの制御仕様

PCから角度の指令を受け取りPWM信号を生成します。 ノイズによる誤動作を防ぐため、同じ角度の指令を3回連続で受信したときのみ目標値を更新する仕組みを取り入れています。 通信が途切れた場合は最後の角度を保持し続けます。 初期姿勢は90度に設定されています。

Solenoid Valveモジュールの制御仕様

2バイトのデータの中に12個の電磁弁のオンオフ状態をビットとして割り当てて通信します。 ServoモジュールやSolenoid Valveモジュールでは、200ミリ秒以上通信がない場合は状態確認用のLEDが消灯するようになっており、通信が正常に行われているかを目視で確認できます。

Note

著者:Shion Noguchi