MODULE M7 · 15.0 HOURS

ファームウェア開発および制御

0% 完了

LEARNING OBJECTIVES

このモジュールの目標

  1. DYNAMIXEL スマートアクチュエータ通信および制御フレームワークの理解
  2. OpenCR 制御ボードを活用したアクチュエータおよび FSR センサ信号取得の実装
  3. リアルタイムロボット制御の状態機械および閉ループフィードバックループ設計
  4. 安全な電源管理およびトルクオフシーケンスプログラミング

ファームウェアアーキテクチャおよび DYNAMIXEL 制御

ロボットハンドのファームウェアは、高速ループ内でセンサデータを取得し、アクチュエータ命令を処理します。OpenCR 1.0 制御器は 216MHz ARM Cortex-M7 プロセッサをベースとし [S13]、別途のブリッジなしで DYNAMIXEL プロトコル 2.0 を処理して [S11] 遅延時間を最小化します。各アクチュエータは電流、速度、位置モードをサポートし、ロボットハンドは電流制御を通じたトルクベースの把持戦略を使用します。

FSR 力フィードバックシステム

FSR 402 センサは、加えられた力に反比例する抵抗特性を持ちます [S12]。OpenCR の 12 ビット ADC を使用し [S13]、3.3V センサレールから 10kΩ 抵抗と電圧分圧回路を構成します。分圧された電圧は ADC値 = (V_in * R_fsr) / (R_fsr + R_ref) を通じて正規化され、この値は指の腱張力と連動して把持力フィードバックとして使用されます。

安全な制御ルーチン

システム停止は安全のために二段階に分けられます。ソフトウェア段階ではアクチュエータのトルクをオフ（Torque Off）にして物理的駆動力即座に除去します。整備前には必ず 3 個の独立電源アダプタの電源を物理的に分離した後、マルチメータの DC モードを使用してすべての分岐で 1V 未満であることを確認しなければなりません。

WORKED EXAMPLES

解説例

  1. 1. アクチュエータ目標位置/電流設定: DYNAMIXEL SDK を使用して XM430 アクチュエータの電流制限（Goal Current）を設定し、センサ値に応じた PID ループを通じて指関節の最終位置を更新する例題。
  2. 2. FSR 電圧データフィルタリング: ADC で収集された生データのノイズを除去するために移動平均フィルタ（Moving Average Filter）を適用し、上限（20N）と下限（0.2N）範囲を正規化するコード実装 [S12]。

LAB PROTOCOL

ロボットハンド統合制御および精密把持実習

  1. 1

    各独立分岐の電圧が 1V 未満であることをマルチメータ DC モードで確認した後、組立を開始する。

  2. 2

    OpenCR の 3.3V センサレールに FSR 電圧分圧回路をはんだ付けし、ADC ポートに接続する。

  3. 3

    DYNAMIXEL SDK を使用して 11 個のアクチュエータの ID をスキャンし、初期位置を設定する。

  4. 4

    無負荷状態で指関節駆動命令をテストしながら、腱の伸長率と張力を調節する。

  5. 5

    FSR センサデータをシリアルモニタで視覚化しながら把持力応答をチューニングする。

安全確認
  • 絶対に 5V または 12V アクチュエータ電源を FSR センサ回路の供給電源として使用しないこと。
  • システム通電中には決して指の可動範囲に近づかず、固定治具を使用すること。
  • 電源分岐アダプタの陽(+)端子を絶対に相互接続しないこと。
  • 整備・組立接近前には、必ず 3 個の電源アダプタを物理的に分離し、すべての分岐で 1V 未満であることを計測確認すること。

実習提出物

  • リアルタイムセンサデータフィードバックが含まれたファームウェアソースコード
  • 電圧分圧データの正規化および校正データシート
  • アクチュエータフィードバックループ正常作動ログ

ASSIGNMENT

把持状態機械設計および実装

提出物

評価基準

  • センサ値に応じた電流制限範囲( 0- 2.3A)が安定的に制御されているか？
  • トルク解除指令時、物理的な張力が即座に除去されるか？
  • コード内に安全なハードウェア分離手順が明示されているか？

KNOWLEDGE CHECK

理解度チェック

1FSR 402センサーと電圧分割回路を構成する際に推奨される電源レールは何ですか？
2ロボットハンド整備時に、システムが「無電源状態」であることを確認する正しい方法は何ですか？
3複数の独立した電源アダプター出力のプラス(+)端子を並列に接続してもよいですか？

FIELD CHECK

完了基準

  • 各分岐別の独立した電源供給およびヒューズ保護がBOM仕様に従って構成されたことをマルチメーターで検証完了
  • OpenCR ADCを通じた5個のFSRセンサーの精密な力信号取得およびフィルタリング確認
  • ソフトウェアのトルク解除ルーチンと物理的な電源遮断後の計測手順を完璧に遂行
  • 把持ステートマシンが意図通りにアクチュエータとセンサーデータを処理し、最終報告書が提出された

MODULE SOURCES

このモジュールの根拠

  1. OpenCR 1.0emanual.robotis.com · technical_documentation
  2. XM430-W350 e-Manualemanual.robotis.com · datasheet
  3. FSR Model 402interlinkelectronics.com · datasheet