技術的概要：リ群における経路追従のためのベクトル場とロボット制御への応用

問題定義

全方位航空機、水中ロボット、マニピュレータのエンドエフェクタなど、多くのロボットシステムは、位置と姿勢（ポーズ）を独立して制御する能力を有しています。これらのシステムは 3 次元空間内の剛体として動作し、ユークリッド空間ではなく、構成多様体 $SE(3)$ 上で進化します。ここで扱われる核心的な問題は経路追従、すなわち、事前に割り当てられた時間パラメータ化なしに、システムを幾何学的曲線へと誘導することです。軌道追跡とは異なり、経路追従は空間タスクを時間仕様から分離するため、外乱に対する堅牢性の向上、より滑らかな収束、および制御労力の削減といった利点を提供します。

ユークリッド空間（$\mathbb{R}^n$）における経路追従には誘導ベクトル場が成功裏に適用されてきましたが、この枠組みを $SE(3)$などのリ群へ拡張することは課題を伴います。従来のアプローチでは、多様体を高次元のユークリッド空間に埋め込み、制御入力を投影し直すことが多く、その結果、冗長な制御次元（例えば、$SO(3)$ に対して本質的な 3 次元の代わりに 9 次元）が生じていました。さらに、多様体上の既存の手法は、曲線の暗黙的なレベルセット定義に依存することが多く、複雑な経路の指定にとって不便な場合があります。本論文は、最小かつ非冗長な制御入力（例えば、ボディツイスト）を生成し、パラメトリック曲線表現をサポートする、連結行列リ群上の経路追従のための一般的な内在的ベクトル場枠組みの必要性に対処します。

手法

理論的枠組み

著者は、連結行列リ群 $G$ に対する一般的なベクトル場戦略を提案します。システムダイナミクスは、一次の完全駆動システムとしてモデル化されます：
$$\dot{H}(t) = S(\xi(t))H(t)$$
ここで、$H(t) \in G$ は状態、$\xi(t) \in \mathbb{R}^m$ は制御入力（一般化ツイスト）、$S$ は $\mathbb{R}^m$ からリ代数 $\mathfrak{g}$ への線形写像です。

誘導ベクトル場 $\Psi(H)$ は、2 つの成分の和として構成されます：
$$\Psi(H) = k_N(H)\xi_N(H) + k_T(H)\xi_T(H)$$

1. 法線成分（$\xi_N$）： 曲線への収束を担います。これは距離関数の勾配から導出されます。
2. 接線成分（$\xi_T$）： 曲線に沿った移動を担います。これは、曲線上の最接近点における接線ベクトルとして定義されます。

主要な数学的革新

ユークリッド空間のベクトル場アプローチ（特に文献 [11] から）をリ群へ拡張するために、著者は特定の演算子と距離の性質を導入します：

• 演算子：
  • $\Xi$ 演算子： 群上の微分可能な経路からリ代数の速度ベクトルを抽出します。これは時間微分 $\frac{d}{dt}$ に相当します。
  • $\mathcal{L}$ 演算子： リ群上の勾配演算子 $\nabla$ に相当し、群構造に沿った方向微分の極限を通じて定義されます。
• 距離関数の要件： この枠組みは、3 つの重要な性質を満たす要素間（EE-）距離関数 $\bar{D}$ に依存します：
  1. 左不変性： $\bar{D}(AV, AW) = \bar{D}(V, W)$。これにより、法線成分と接線成分が直交することが保証されます。
  2. 連鎖性： 2 点間の距離は、それらを接続する特定経路に沿った距離の和に等しくなります。この性質は、目標曲線以外の局所最小値が存在しないことを保証します。
  3. 局所線形性： 距離は経路近傍で線形的に振る舞い、勾配（法線成分）が曲線外で決して消滅しないことを保証します。

$SE(3)$ への特化

$SE(3)$ の特定の場合について、本論文は特殊指数リ群のクラスを定義します。これらの群に対して、行列対数のフロベニウスノルムを用いた有効な EE-距離が構成されます：
$$\bar{D}(V, W) = \| \log(V^{-1}W) \|_F$$
この定式化により、距離とその微分を計算するための明示的かつ効率的なアルゴリズムが可能となり、一般的な測地線計算の計算コストを回避できます。制御入力 $\xi$ は、ロボットのツイスト（線形速度と角速度）に直接対応し、入力次元がシステムの自由度と一致することを保証します。

主要な貢献

1. リ群への一般化： 本論文は、ベクトル場戦略をユークリッド空間から連結行列リ群へ拡張し、構成空間の内在的幾何学を尊重する非冗長な制御入力を生み出します。
2. 形式的証明と距離の性質： 著者は収束と移動に関する形式的証明を提供し、ベクトル場の安定性を保証するために距離関数が満たすべき特定の性質（左不変性、連鎖性、局所線形性）を導出します。
3. **$SE(3)$向けの効率的アルゴリズム：** 特殊指数の性質を利用して距離と勾配を計算し、冗長な次元を回避する、$SE(3)$ 上での戦略実装のための効率的なアルゴリズムが開発されました。
4. 実世界での検証： 複雑なポーズ経路を追跡する Kinova Gen3 ロボットマニピュレータを用いた実験を通じて、アプローチが検証されました。

実験結果

著者は、7 自由度の Kinova Gen3 マニピュレータを用いて実験を行いました。エンドエフェクタは、自己衝突と関節制限を回避する $SE(3)$ 内の複雑な離散化曲線の追跡を任務としました。

• 性能： システムは望ましい曲線へ成功裏に収束し、それを通過しました。
• 指標： 曲線へのユークリッド距離（EC-距離）は時間とともに減少し、システムは経路上に到達した後、低い位置・姿勢誤差を維持しました。
• 計算効率： ベクトル場の計算は、標準 CPU 上で反復あたり平均 8.9 ms でした。著者は、この時間の 99.5% が曲線上の最接近点を見つけるための最適化問題の解決に費やされたことに言及しており、並列化（例えば GPU による）によるさらなる高速化の可能性を示唆しています。
• 観察： ロボットが特異構成付近で動作する際には、頻繁な姿勢調整を必要とする誤差のわずかな変動が観測されましたが、システムは安定していました。

意義と主張

本論文は、リ群上で動作するロボットシステムのための経路計画、経路追従、制御を統合する統一枠組みを提供すると主張しています。その主な意義は以下の点にあります：

• 内在的制御： 高次元空間から制御を投影する手法とは異なり、このアプローチは、工学システムに直接適用可能で最小限の制御入力（ツイスト）を生成します。
• パラメトリック柔軟性： レベルセットの交差ではなくパラメトリック曲線表現を採用することで、この枠組みは複雑な曲線をより自然に受け入れ、これは実用的なロボットタスクにとって重要です。
• 堅牢性： 「ほぼ大域的」な収束の理論的保証（小さな摂動による問題集合からの脱出能力を含む）と、空間タスクと時間タスクの分離は、混雑した環境での実世界ナビゲーションに実用的な利益をもたらします。

著者は、現在の距離計量が特殊指数リ群に固有のものである一方で、この枠組みが時間変化する曲線、不完全駆動システム、およびより一般的な距離関数に関する将来の研究への道を開くと結論付けています。さらなる研究と応用を促進するため、オープンソースの実装が提供されています。