ファームウェアと通信仕様
各モジュールのファームウェアは、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