External and Internal Impedance for Robot Teams Sharing a Load: Exact Decoupling and Decay Certificates

技術要約：ロボットチームによる負荷共有のための外部および内部インピーダンス

問題提起
本論文は、$N$台のロボット（冗長なアクチュエーションを持つ移動ベースおよび浮遊ベースを含む）のチームが、共通の剛体ペイロードを協調的に操作する際の制御における課題に対処している。核心となる問題は、以下の2つの異なる振る舞いを同時に制御することである：

1. 外部インピーダンス： ペイロードと環境との相互作用（接触力と運動）を制御する。
2. 内部インピーダンス： 不必要な運動を誘発することなく、ロボットがペイロードに加える内部レンチ（力とトルク）を制御する。

[6]におけるデュアルアーム・フレームワークなどの既存のアプローチは、完全なインナーループ追従を前提としていることが多く、複雑な制約を持つ大規模なチームに対して明示的な指数関数的収着率を証明することに苦慮している。また、一貫性のないリファレンス要求（例：独立したロボットコントローラからの要求）は、意図しない内部レンチ（拮抗作用）を生成し、ペイロードの運動にバイアスを与える可能性がある。著者らは、グラフ構成されたロボットチームへとインピーダンス制御を拡張し、運動と内部力の厳密なデカップリングを提供し、インナーループの追従誤差やモデルの不確実性にもかかわらず安定性を保証することを目指している。

手法
提案されるフレームワークは、構成されたメカニズムグラフモデルに基づいた2ループ制御アーキテクチャを利用する：

1. インナーループ（モデルベースVDC）：

   • インナーループは、仮想分解制御（VDC）アプローチを採用している。これは、要求されたアクチュエータ速度（$w$）を受け取り、制約違反を最小化するためにレートゲイン指標（$K$）を用いて、許容可能な運動（$u_r$）に適合させる。
   • 正確な動力学モデルと計測された環境レンチに基づき、必要な努力量（$f_r, \lambda_r$）を計算する。
   • 制御則には、追従誤差を補償するためのフィードフォワード項が加えられ、さらに内部コマンド（$\psi$）が内部レンチを制御するために注入される。

2. アウターループ（インピーダンスおよびリファレンス生成）：

   • 外部インピーダンス： コンプライアントなフレーム（$x_c$）を定義し、指定された質量、減衰、および剛性行列（$M_c, D_c, K_p, K_o$）を用いて、目標ポーズ（$x_d$）を追従させる。これがペイロードと環境との相互作用を司る。
   • 内部インピーダンス： 内部コマンド $\psi$ は、内部レンチ誤差（$\lambda_I - \lambda_d$）によって駆動される質量・ばね・ダンパ動力学を介して生成される。これにより、積分動作（$K_z=0$）または比例剛性（$K_z > 0$）による、拮抗的な力の除去が可能となる。

3. 理論解析：

   • 著者らは、インナーループの追従誤差を考慮した厳密な誤差パワー恒等式を導出している。
   • 内部レンチが、指令された負荷、一貫性のない要求による反対方向の負荷（拮抗作用）、および減衰する運動誤差の3つの成分に分離されることを証明している。
   • デカップリング： 運動要求と環境レンチは内部コマンドから独立していることが示されており、慣性モデルの誤差がある場合でも、内部の力がペイロードの運動を駆動しないことが保証されている。
   • 安定性： リアプノフ法を用い、時間スケールの分離を必要とせずに、システムゲインとモデルによって決定される明示的な収束率をもって、すべての誤差（追従、相互作用、および内部レンチ）に対する局所的な指数関数的収束を確立している。

主な貢献

1. 厳密な内部レンチ構造： 本論文は、内部レンチ（$\lambda_I = \psi + \Psi K w_\perp + \Theta s$）の厳密な分解を提供し、指令、一貫性のないリファレンスによる拮抗作用、および追藤誤差の各項を明示的に特定している。
2. 認証された収束率： 漸近安定性を証明する従来の作業とは異なり、本研究は、インナーループの誤差を含む全クローズドループシステムに対して、明示的な指数関数的収束率（$\min\{\kappa_s, \kappa_\xi, \kappa_z, \kappa_T\}$）を提供する。
3. 実行可能性およびバイアス条件： リファレンスの変位のための計算可能な部分空間を定義している。リファレンスコマンドが運動バイアスを生じさせることなく内部力を生成するための必要十分条件が、当該部分空間内に存在することであることを証明している。
4. 実行時実行可能性の認証： システムの状態と誤差境界に基づき、把握（グラスプ）および支持の実行可能性（例：接触力が摩擦錐内に留まっていることの確保）を認証するための実行時不等式を導出している。

結果
本フレームワークは、4台のApptronik Apollo ヒューマノイドが63 kgのアルミニウム製ガーダー（ロボット1台あたり約16 kg）を運搬する、高精度なMuJoCoシミュレーションを通じて検証された。

• 性能： チームは、ガーダーの歩行、持ち上げ、運搬、および荷降ろしに成功した。ペイロードはコンプライアントフレームから7.0 mm以内に保持されていた。
• 内部と外部のデカップリング： パーム荷重をシフトさせるために内部コマンドを適用した際、ガーダーの動きはわずか 0.2 mm であった。対照的に、[6]の投影なしの参照変位法を用いた場合、同一条件下で 1.9 mm のガーダー運動が発生した。
• ロバスト性： システムは、リンク慣性の $\pm 30\%$ の摂動およびペイロード質量の $+20\%$ の増加に対して、安定性を維持した。
• 容量推定： 静的な容量推定値（$U^\star$）は、質量スイープ全体にわたってミッションの成否を正確に予測した。$U^\star < 1$（単一支持）のミッションは成功したが、$U^\star > 1$ のミッションではペイロードの喪失に至った。
• 拮抗作用の除去： シミュレーションにより、内部インピーダンスループにおける積分動作（$K_z=0$）が、モデル誤差や一貫性のないリファレンスによって引き起こされる定常状態の拮抗作用を効果的に除去できる一方で、比例剛性（$K_z=I$）はそれを軽減するものの、完全には排除できないことが確認された。

意義
本論文は、[6]のデュアルアーム・インピーダンス・フレームワークを、移動ベースおよび冗長なアクチュエーションを持つ一般的なロボットチームへと拡張するものである。その主要な意義は、運動と内部力のデカップリング、およびシステムの指数関数的安定性に関する厳密な理論的証明を提供している点にある。インナーループの追従誤差と一貫性のないリファレンスを厳密に考慮することで、本研究は、内部力の制御が運動の追従を損なわない、協調的な操作のための堅牢な手法を提示している。結果は、提案手法が精密な内部負荷制御（例：摩擦把握）を可能にしながら、高い忠実度の外部インピーダンス挙能を維持できることを示しており、ヒューマノイドが搬送タスクを行う複雑な接触豊富なシミュレーションによって検証されている。