Actuator-Aware Inverse Kinematics with Joint-Limit Admissibility for Torque-Controlled Redundant Robots

技術要約：トルク制御冗長ロボットのための、アクチュエータを考慮した逆運動学と関節限界許容性

問題提起
冗長ロボットは、特定のタスク空間の運動を実現するために必要な以上の駆動関節を備えており、関節限界回避などの二次的な目的を達成するための余剰自由度を有している。しかし、トルク制御アーキテクチャにおいて、逆運動学（IK）の出力は最終的な制御入力ではなく、下流のトルクレベルコントローラ（例：仮想分解制御）に供給される参照速度となる。したがって、指令された運動学的残差のみを最小化しても、良好な実現運動が保証されるわけではない。生成された関節速度参照が、下流のコントローラのダイナミクスやアクチュエータの容量制約と不適合である場合、物理システムはタスクの追従に失敗する可能性があり、特に関節限界付近でその傾向が顕著になる。既存のIK手法は、運動学的基準（例：最小ノルム、零空間投影）に基づいて冗長性を解決することが多く、特定のトルクレベルの制御ループやアクチュエータの容量制約に対する参照の適合性を明示的に考慮していない。

手法
本論文では、エンドポイントの軌道と冗長ロボットのトルクレベルコントローラの間の中間層として機能するように設計された、凸二次計画法（QP）を介して関節レベルの必要速度（$\dot{q}_r$）を生成する、コントローラ適合型IK定式化を提案する。

1. コントローラ適合性目的関数： このQPは、タスクの維持とコントローラの適合性のバランスを取るコスト関数を最小化する。重み行列（$W_c$）には以下が含まれる：

   • 等方性ベースライン： 良好な条件付けを確保する。
   • 前回の指令との一貫性（$W_\Delta$）： 前ステップに対する必要速度の急激な変化を抑制し、滑らかさを促進する。
   • アクチュエータ・トルク容量重み付け（$W_\tau$）： システム内で最も強力な関節に対する、低容量のアクチュエータの使用を抑制する。この重み付けは、測定されたトルクではなく、既知のアクチュエータ制限から導出される。

2. 関節限界許容性： QPを不能にするようなハード制約を用いる代わりに、本手法は制御バリア関数（CBF）型の不等式を用いて、許容される必要速度の集合（$D_r(q)$）を定義する。これらの境界は、指令された速度が関節を機械的限界へと急速に駆動させないように制御する。

3. ソフトタスク制約： タスク指令が許容可能な速度集合と不適合である場合に備え、タスク方程式（$J\dot{q}_r = V_r$）はスラック変数（$s$）を用いたソフト制約として扱う。タスク残差は、主たる最小化対象ではなく、目的関数内でペナルティとして扱われる。これにより、必要に応じてコントローラの適合性を優先できるよう、ソルバーがタスクの維持とコントローラの適合性の間でバランスを取ることが可能になる。

主な貢献

• 定式化： トルク制御ロボットの冗長性解決において、アクチュエータのトルク容量と前回の指令との一貫性を明示的に組み込んだ、新しいQPベースのIK定式化。
• 参照レベルの安全性： プラントの入力ではなく、必要速度（IKの出力）に対してCBF型の境界を導入することで、既存のトルクレベルコントローラを変更することなく、参照レベルでの関節限界許容性を実現。
• タスク許容性のトレードオフ： タスク方程式にスラック変数を用いることで、タスクの維持とコントローラの適合性のバランスを取るメカニズムを提供し、タスク残差が適合性の必要性を上書きすることを防ぐ。

実験結果
提案手法は、仮想分解制御（VDC）フレームワークを用いた7自由度の上肢外骨格を用いて評価された。比較対象として、擬似逆行列（PINV）、減衰最小二乗法（DLS）、零空間関節限界回避（NS-JLA）、および同一の許容制約を用いつつコントローラ適合性の目的関数を持たないタスク保持型QP（TP-QP）の4つのベースラインを用いた。

• 実現性能： 提案手法は、最も低い位置および姿勢の二乗平均平方根（RMS）誤差、および最も低い実現タスク速度残差を達成し、すべてのベースラインを上回った。特に、TP-QPベースラインと比較して、RMS位置誤差を29.6%、RMS姿勢誤差を20.2%減少させた。
• 限界挙動： 提案手法は、「限界押し（limit-pushing）」指数（限界方向への運動を指令する指標）が著しく低く、他の手法と比較して最大96%減少した。
• トルク効率： 最も低いRMSトルクノルムを示し、アクチュエータ資源のより効率的な使用を示唆した。
• 許容性： 提案手法は、許容される必要速度の境界違反をゼロに維持したが、運動学的ベースライン（PINV, DLS, NS-JLA）は頻繁にこれらの境界を超過した。

意義と主張
本論文は、トルク制御された冗長ロボットにとって、IKは単に運動学的誤差を最小化するだけでなく、下流のコントローラおよびアクチュエータの能力と適合する関節レベルの参照を生成しなければならないと主張している。実験結果は、提案された定式化が、タスクの維持と許容性の間で優れたバランスを実現することを示している。アクチュエータ容量を尊重し、過度な限界押しを回避する参照を生成することにより、既存のトルクレベルコントローラの再設計を必要とせずに、実現されたタスク挙動を向上させている。著者らは、これらの知見を、形式的なプラントレベルの安全性証明ではなく、「参照レベルの関節限界認識」および「コントローラ適合型の冗長性解決」として控えめに位置づけている。今後の課題として、結合されたIK–トルク制御制約の定式化および形式的な閉ループ制約分析の調査が挙げられている。