Gravity Compensation of the dVRK-Si Patient Side Manipulator based on Dynamic Model Identification

技術要約：動的モデル同定に基づくdVRK-Si 患者側マニピュレータの重力補償

問題提起
da Vinci Research Kit (dVRK) は、ロボット支援手術の研究を推進するための重要なオープンソースプラットフォームである。従来のdVRK Classicシステムでは、患者側マニピュレータ（PSM）における重力の影響は無視できる程度であったが、da Vinci Si 手術システムに由来する新しいdVRK-Siシステムは、構造的にアップグレードされたPSMを備えている。この構造的な変更により、無視できない重大な重力オフセットが生じている。dVRK-Si PSMにおいて重力が補償されないと、制御精度が低下し、応答時間が長くなる。動的モデルの同定についてはdVRK Classicに対して既に取り組まれているが、dVRK-Siの機械的な違いにより、性能向上のためのモデルベース制御に関する新たな研究が必要となっている。

手法
著者らは、dVRK-Si PSMのための包括的な重力補償（GC）のアプローチを提案している。これは、完全な動的モデルパラメータを同定し、補償のための重力項 $G(q)$ を分離することを中心としている。手法は以下の5つの明確なステップで進行する：

1. 運動学モデリング： 製造元の仕様と物理的測定に基づき、dVRK-Si PSMの完全な運動学モデルを構築した。このモデルは、修正されたDenavit-Hartenberg (DH) パラメータ（表Iに詳述）を利用し、リモートセンター・オブ・モーション（RCM）を含むSi PSMの複雑なリンク機構を考慮するために、特定のフレーム構造（図2）を定義している。
2. 動力学モデリング： オイラー・ラグランジュ法を用いて動的モデルを導出した。運動方程式は $M(q)\ddot{q} + C(q, \dot{q})\dot{q} + G(q) = \tau$ と表され、目標はリンク慣性、モータ慣性、摩擦、および剛性を表すパラメータベクトル $\delta$ を同定することである。
3. 励起軌道の設計： パラメータ同定のための豊かなデータ収集を確実にするため、関節制約と動的モデルに基づいて最適な励起軌道を計算した。
4. データ収集： 物理的なdVRK-Si PSM上で励起軌道を実行し、運動学的および動的なデータを収集した。
5. パラメータ同定： 動的パラメータは凸最適化アプローチを用いて解かれた。過学習を防ぎ物理的な妥当性を確保するため、最適化には特定の制約を組み込んだ。具体的には、リンク質量は正であること、重心はリンクの凸包内に留まること、そして摩擦係数、モータ慣性、およびスプリング剛性が正であることである。

主な貢献
本論文は主に2つの貢献を示している：

• 正確なモデリングに必要なフレーム関係とパラメータを明示的に定義した、dVRK-Si PSMの新しい完全な運動学モデル。
• 動的モデル同定に基づく重力補償戦略。完全な動的モデルを同定することで、著者らはヒューリスティックなモデルや簡略化されたモデルに頼るのではなく、重力補償に必要なトルクを提供するために $G(q)$ 項を抽出している。

結果
提案された重力補償の有効性は、ドリフトテストを通じて検証された。この実験では、標準的なPD位置制御器を用いてPSMを所望のポーズに移動させた後、5秒間、オープンループのトルクベースの重力補償モードに切り替えた。ドリフトは、1度または1 mmを超える動きと定義された。

• ドリフト性能： システムは、5つのランダムなテスト構成において、顕著なドリフトなしにロボットのポーズを維持した。
• 誤差の低減： 重力補償アプローチは、PD制御器単独と比較して、より小さな定常偏差を示した。
• トルク分析： 重力の影響を最も受ける最初の3つの関節に対して生成された関節トルクは、静止摩擦に対して関節を保持するために必要な計算上の下限および上限の範囲内に収まった。ほとんどの場合、これらのトルクは実行可能な範囲の中点に近い値であった。
• 第3関節の観察： 第3関節（プリズム型関節）において、トルクの中点からの偏差が観察された。著者らはこれを、プリズム型関節およびカニューラにおける顕著な摩擦に起因するものとしている。

意義と主張
著者らは、提案された重力補償アプローチが、システムの構造的アップグレードに伴う重要な制限に対処し、dVRK-Si PSMのポーズを顕著なドリフトなしに効果的に維持できると主張している。本研究は、同じ取付角度構成を共有していれば、異なるdVRK-Si PSM間でもモデルベースの同定が正常に一般化できることを示している。正確な重力補償を可能にすることで、本研究はより高い制御精度と高速な応答時間を実現し、それによってdVRK-Siプラットフォームのためのより高度な研究および制御アプリケーションをサポートするものである。本研究は、すべての動的制御の課題を解決することを主張しているのではなく、特にSi PSMの設計に固有の重力オフセットの問題を対象としている。