Compliant Explicit Reference Governor for Contact Friendly Robotic Manipulators

技術的概要：接触親和型ロボットマニピュレータのためのコンプライアンス Explicit Reference Governor

問題定義
従来のロボット運動計画は、安全性を確保するために衝突回避を最優先し、環境との接触をしばしば障害として扱ってきた。しかし、現代のロボット工学では、物理的相互作用を資源として活用する「接触に富む（contact-rich）」能力がますます必要とされている。核心的な課題は、自由運動と接触との間の遷移を管理しつつ、2 種類の異なる制約条件を満たすことにある。

1. ハード制約: 関節の可動域、トルク限界、禁止表面など、妥協の余地のない限界。
2. ソフト制約: 接触は許容されるが、安全に処理されなければならない条件。これらは極めて非凸な「OR」条件を創出する。すなわち、ロボットは接触を完全に回避する「か」、特定の接触安全制限の下で動作する「か」のいずれかを満たさなければならない。

既存の最適化ベースの戦略（モデル予測制御など）は、制御則の完全な再設計と、接触力学の複雑な時間変動近似を必要とすることが多く、レガシー制御器を持つ実務者には魅力的ではない。一方、制御バリア関数やエネルギーベースのコンプライアンスなどの階層的アプローチは、厳密な制約保証や漸近安定性を欠くことが多い。Explicit Reference Governor（ERG）は、基盤となる制御器を変更せずに参照信号を修正する階層的な安全フィルタを提供するが、従来の実装では接触を望ましくないものとして扱い、接触発生時に運動を停止させていた。本論文は、低レベル制御器を変更することなく、接触中の安全かつ連続的な動作を可能にするフレームワークの必要性に対処する。

手法：コンプライアンス Explicit Reference Governor（CERG）
著者らは、高レベルプランナと低レベル制御器の間に配置されるモジュラー型の参照管理システムである、コンプライアンス Explicit Reference Governor（CERG）を提案する。CERG は、操作制約を強制し、事前安定化された制御器に送信される参照信号 $v(t)$ を操作することで、自由運動と接触動作間の滑らかな遷移を可能にする。

この手法は、以下の 3 つの主要な構成要素に依存する。

1. 事前安定化層: 標準的な重力補償付き PD 制御器が、ロボットを参照構成 $v$ へと誘導する。システムの全エネルギー（運動エネルギー＋仮想ポテンシャル）は、$v$ が一定のとき単調減少するリャプノフ関数 $V(x, v)$ によって定義される。
2. コンプライアンス動的安全マージン（DSM）: 核心的な革新は、接触制約の排他的（OR）性質を処理するように設計された DSM、$\Delta(x, v)$ である。安全条件は以下のように定式化される。
   $$s(q(t)) < 0 \quad \lor \quad V(x(t), v(t)) \le E_{\max}$$
   ここで、$s(q) < 0$ は自由運動を表し、$V \le E_{\max}$ は有界エネルギーによる安全な接触を表す。CERG は、合成 DSM を構築する。
   $$\Delta(x, v) = \min(\Delta_h, \max(\Delta_s, \Delta_E))$$
   • $\Delta_h$: ハード制約（関節限界など）を強制する。
   • $\Delta_s$: ソフト制約表面 $s(q)$ に対する軌道ベースのマージン。
   • $\Delta_E$: $\kappa_E(E_{\max} - V(x, v))$ と定義されるエネルギーベースのマージン。
     この構造により、ロボットが自由運動中であればエネルギー制約は緩和され、接触が発生すればシステム全体のエネルギーは $E_{\max}$ によって厳密に制限される。
3. ソフトナビゲーション場（NF）: 参照を反発させるハード制約とは異なり、CERG は参照 $v$ が制約境界を限界 $\delta_s$ まで浸透することを許容する「ソフト」な反発場 $\rho_s(v)$ を採用する。この浸透は、コンプライアンス接触に必要な力を生成するために不可欠である。全ナビゲーション場は、ターゲットへの引力、ハード制約からの反発力、およびこのソフト反発力を組み合わせたものである。

主要な貢献
本論文は、以下の 3 つの主要な貢献を主張する。

• モジュラー型参照フィルタリング: 制御器の再設計を必要とすることなく、関節角度、速度、トルク制約を尊重しつつ、接触なし運動と接触に富む運動をシームレスに遷移させるフレームワーク。
• 排他的制約処理: 「OR 型」の制約のために特別に設計された安全機構。接触の回避、あるいは接触中の有界エネルギー維持のいずれかを証明可能に満たすことを保証する。
• エネルギーベースの安全ガイドライン: クロースドループシステムの全機械的エネルギー（ポテンシャル＋運動）に基づく安全指標。この指標は座標系不変であり、安定性の保証に直接結びつき、解釈が容易である。

結果と検証
CERG は、複雑さを増すシステムに対して数値的および実験的に検証された。

• 2 リンク平面アーム（シミュレーション）: CERG は、関節空間制御器とエンドエフェクタ制御器の両方でテストされた。結果、CERG は CERG 不使用の場合と比較して相互作用力を効果的に低減し、エネルギー限界を遵守することが示された。研究では、エンドエフェクタ空間定式化はカルテシアン誤差を最小化するが、階層的アーキテクチャには関節空間定式化が好ましいと指摘された。
• Franka Emika Panda シミュレーション（Drake）: 摩擦と散逸を備えたコンプライアンス接触モデルを用い、壁に沿ってアームを滑らせるタスクで CERG をテストした。シミュレーションは、CERG が接触中に $E_{\max}$ 限界を遵守したことを確認した。一方、接触時に停止する標準 ERG と、修正されていないシステムは、エネルギー遷移を効果的に管理できなかった。
• 実世界実験（Franka Emika Panda）: 2 つのタスクが実行された。
  1. ホワイトボード拭き: エネルギーに対して感度が低いタスク。CERG、ERG、インピーダンス制御のすべてがタスクを完了したが、接触中にハード制約（関節速度違反の防止）とエネルギー限界を強制したのは CERG だけだった。
  2. ジェンガタワー押し: エネルギーに対して極めて敏感なタスク。インピーダンス制御器は、関節限界違反またはタワーの転倒により失敗した。標準 ERG は、過剰な接触エネルギーによりタワーの転倒を防げなかった。CERG のみが、接触中に $E_{\max}$ を厳格に強制しつつ自由運動中はより高いエネルギーを許容することで、タワーを転倒させずに押し進めることに成功した。

意義と主張
本論文は、CERG が「プラグアンドプレイ」型の安全フィルタとして機能することで、接触に富むマニピュレーションに対する実用的な解決策を提供すると主張する。その意義は、完全な MPC 再設計の計算負荷や、修正されていない制御器の不安定性リスクを伴うことなく、ロボットが接触を危険ではなく資源として扱えるようにする点にある。このフレームワークは、全システムエネルギーに対する証明可能な制約を通じて安全性を保証し、自由運動と接触間のシームレスな位相遷移を可能にする。著者らは、このアプローチが実現可能かつ効果的であると結論付け、今後の作業として CERG をタスク指向プランナと連携させることを計画している。