技術的概要：遠隔操作における可変インピーダンスによる高精度追従のための意図吸収制御

1. 問題定義

遠隔操作システムは通常、フォロワーロボットをリーダーの位置へ引き寄せるために、バネのような力に依存しています。この従来のアプローチには根本的なトレードオフが存在します。

• 低剛性: 繊細な物体や人間との相互作用において安全性を確保しますが、特に動的な動作中は追従精度が低下します。
• 高剛性: 高精度な追従を確保しますが、共有環境では安全性のリスクを伴い、オペレーターがインピーダンスを急速に変更した際に不安定化や「むち打ち」効果を引き起こす可能性があります。

既存の最先端ソリューションであるテレインピーダンス制御（TIC）などは、オペレーターの腕のインピーダンスを（筋電図や把持力を通じて）推定し、フォロワーのインピーダンスをそれに一致させることでこの問題を解決しようと試みています。しかし、TIC は依然としてリーダーの現在の位置を目標として伝達します。その結果、フォロワーのインピーダンスが低い（コンプライアントな）場合、オペレーターが物理的な剛性を高く維持（共収縮）しない限り、フォロワーはリーダーの軌跡を正確に追従できません。これは疲労を招き、持続不可能です。逆に、フォロワーが剛性が高い場合、環境を損傷するリスクがあります。

ここで扱われる核心的な問題は、追従性能や安全性を損なうことなく、オペレーターがフォロワーのインピーダンスを低から高へ自由に調整できる状態で、フォロワーロボットがリーダーの動きを正確に追従できるようにする方法です。

2. 手法：意図吸収制御（IAC）

著者らは、追従精度をフォロワーの瞬間的なインピーダンスから切り離す戦略として、**意図吸収制御（IAC）**を提案します。

中核概念

リーダーの現在の位置（$x_l$）をフォロワーへ伝達する従来の方法とは異なり、IAC はオペレーターが加える力に基づいてリーダーの目標位置（$\tau_l$）を推定し、この推定された目標をフォロワーへ伝達します。フォロワーはリーダーの瞬間的な状態ではなく、この仮想目標（$\tau^*$）を追従します。

制御アーキテクチャ

1. 目標推定: フォロワーはリーダーロボットに加えられた力を観測することで、オペレーターの意図する軌道（$\tau^*$）を推定します。これは、目標軌道が時間の関数である（例：固定位置または線形速度）という内部モデルを用いてモデル化されます。
2. 状態観測: カルマンフィルタが、ロボットの位置、速度、目標軌道パラメータ、およびリーダーの制御入力を含まれる拡張状態ベクトルを推定するために用いられます。この観測器は、推定状態と測定状態（位置、速度、力）との間の誤差を最小化します。
3. 制御則: フォロワーのコントローラーは以下のように設計されます。
   $$u = -L_1(x - \tau^*) - L_2(\dot{x} - \dot{\tau}^*)$$
   ここで、$L_1$ と $L_2$ はフォロワーの剛性および減衰ゲインです。目標 $\tau^*$ が現在の位置ではなく意図された軌道の推定値であるため、収束を達成するために $L_1$ と $L_2$ を高くする必要はありません。これらは安全性のために低く設定するか、動的に変調することができます。
4. インピーダンス変調: オペレーターは、腕の終端剛性と線形相関するパワーグリップ力を通じて、フォロワーのインピーダンスの大きさを制御します。これにより、フォロワーのコンプライアンスをリアルタイムで調整できます。
5. 安定性: インピーダンス制御において既知の問題である剛性の急速な増加時に不安定化することを防ぐため、Kronander と Billard（2016）から導出された条件を用いて剛性増加率を制約します。これにより、システムは急激な遷移中であっても安定性を維持します。

システムダイナミクス

本論文では、リーダーおよびフォロワーロボットを標準的な剛体ダイナミクスを用いてモデル化しています。フォロワーのコントローラーは、リーダーのダイナミクスに一致させるために自身のダイナミクスを補償し、制御入力が同一であればフォロワーがリーダーの挙動を模倣する「一致した」システムを実質的に作成します。

3. 主要な貢献

• 新規制御戦略: 追従パラダイムをリーダーの現在の位置の追従から、オペレーターの意図に由来する推定された目標位置の追従へと転換する IAC の導入。
• 精度とインピーダンスの解離: フォロワーのインピーダンスが低い場合でも高い追従精度を維持できることを実証し、TIC の限界を克服しました。
• 実験的検証: 4 つの異なる実験シナリオにおける IAC と TIC の包括的な比較。
  1. フリー追従: 可変インピーダンスを伴う多軸移動。
  2. ソフトインタラクション: 安全性とコンプライアンスをテストするための風船との相互作用。
  3. ペグインホール: 整合のために高いコンプライアンスを必要とするが、挿入のためには正確な追従を必要とする精密タスク。
  4. 双方向研磨: オペレーターが把持力を通じてインピーダンスを調整する力フィードバックタスク。

4. 実験結果

本研究では、片側タスクには 100 ms の通信遅延、双方向タスクには 0 ms の遅延を伴う 2 台の 7 自由度 Franka Emika マニピュレーターを使用しました。

• フリー追従:

  • TIC: インピーダンスが 400 N/m を下回ると追従誤差が急激に増加しました。低剛性（80 N/m）では誤差が 20 cm を超えました。高剛性は、オペレーターがインピーダンスを増加させた際に「むち打ち」（急激な加速/減速）を引き起こしました。
  • IAC: 全インピーダンス範囲（80–1320 N/m）にわたり、追従誤差を 10 cm 未満（約 5 cm 付近で推移）に維持しました。むち打ちは観察されませんでした。
  • 定量的: 試験範囲全体において、IAC は TIC に対して追従誤差を 2.21 倍削減しました。

• 風船相互作用:

  • TIC: 高いゲイン（300 N/m）であっても、フリー空間では正確に追従できず、コンプライアンス制御の不良により接触時に風船を破裂させました。
  • IAC: 低いゲイン（60 N/m）でも、フリー空間ではリーダーを正確に追従し、風船とは破裂を防ぐために優しく相互作用しました。

• ペグインホール:

  • 参加者: 8 名の未経験者。
  • 成功率: IAC は 20 秒以内に 88% の成功率を達成し、TIC の 50% と比較して有意差がありました（$p=0.02$）。
  • 完了時間: IAC による成功試行は、TIC（17.0 秒）と比較して有意に短時間（10.0 秒）で完了しました（$p<0.001$）。
  • メカニズム: 改善は主に挿入フェーズによって引き起こされました。IAC はフォロワーの向きがリーダーの回転調整に正しく反応することを可能にし、ユーザーが詰まったペグを「揺さぶって」外すことを可能にしました。TIC はフォロワーがコンプライアントな場合、これらの回転補正を効果的に伝達できませんでした。

• 双方向研磨:

  • IAC は、オペレーターが把持力を通じてインピーダンスを調整した場合でも、x-y 平面上で低い追従誤差を維持することに成功しました。
  • 力フィードバックは両モードにおいてリーダーに正確に反映され、安定した双方向操作が確認されました。

5. 意義と主張

本論文は、IAC が片側および双方向の遠隔操作において、フォロワーの位置とインピーダンスに対して前例のない制御レベルを提供すると主張しています。

• 安全性と精度: IAC は従来のトレードオフを解決し、追従精度を犠牲にすることなく、安全で低剛性の相互作用を可能にします。
• ユーザーの自由度: オペレーターは、タスク要件に基づいてインピーダンスを調整できます（例：研磨には低剛性、ドリリングには高剛性）。精度を維持するために筋肉を物理的に共収縮させる必要はありません。
• ロバスト性: この手法は通信遅延（100 ms で試験）に対してロバストであり、試験された構成において安定性のために複雑な受動性アルゴリズムを必要としません。
• 実用性: インピーダンスを推定するためにパワーグリップ力を使用することで、筋電図ベースの手法に関連するノイズや較正の難しさを回避し、実世界への展開をより実用的にしています。

著者らは、IAC がユーザーに環境に適応するインピーダンスの自由度を与えながら、ロボットが人間の動きを正確に再現することを可能にすると結論付けています。これは、安全性または性能のいずれかを犠牲にすることなく達成できない、TIC にはない能力です。