技術要約：ワークスペース・ファイバー分解を用いた $nR$ 平面マニピュレータの完全な運動計画

1. 問題設定

本論文は、混雑した環境における冗長な $nR$ 平面マニピュレータの**完全な運動計画（Complete Motion Planning）**という課題に取り組んでいる。完全なプランナーは、スタートとなる構成（configuration）と目標となるエンドエフェクタ位置の間の衝突のない経路を見つけるか、あるいはそのような経路が存在しないことを証明（認定）できなければならない。

サンプリングベースの手法（SBMP）は高次元空間における経路発見には効率的であるが、不可能性の証明（infeasibility certification）を行うことはできず、多くの場合タイムアウトまで探索を続けてしまう。一方、厳密な構成空間（C-space）分解法（例：円筒代数分解）は完全性を備えているが、次元が増えるにつれて計算複雑性が指数関数的に増大するため、関節数に等しい次元を持つ冗長システムに対しては実行不可能となる。

具体的な問題は、高次元の障害物幾何構造を明示的に構築することなく、平面 $nR$マニピュレータのための連続的な衝突のない経路$\gamma: [0, 1] \to C_{free} \subset T^n$ を見つけるか、あるいは不可能性を証明することである。

2. 手法：ワークスペース・ファイバー分解（Workspace-Fibered Decomposition）

提案されたフレームワークは、問題を低次元のマニフォールド（多様体）のシーケンスへと分解することで、到達可能な計画領域を逐次的に構築する。高次元の C-space で直接計画を行うのではなく、この手法はワークスペース・ファイバー・マニフォールドの階層を構築する。

2.1 逐次的構築

プロセスは最小の非冗長サブチェーン（2R 平面アーム）から始まり、冗長な自由度（DOF）を一つずつ再帰的に追加していく：

1. ベースステージ (2R): アルゴリズムは、2R 構成空間 ($T^2$) においてスタート構成を含む連結な自由空間成分 $C^{(s)}_{free}$ を特定する。これは順運動学を通じて、障害物制約付き到達可能ワークスペース $R^{2R} \subset \mathbb{R}^2$ へと投影される。
   • 不可能性チェック: もし目標位置 $x_g$ が $R^{2R}$ 内に存在しない場合、問題は直ちに実行不可能であると宣言され、以降の計算は回避される。
2. ファイバー・リフティング (Fiber Lifting): 次のリンク $m+1$ に対して、現在の到達可能ワークスペース $R^{mR}$ は、新しいリンクの角度を表す方位ファイバー $S^1$ 上へのリフトによって拡張される。縮小された計画空間は $M^{(m)}_{red} = R^{mR} \times S^1$ となる。
3. 衝突判定: ステージ $m+1$ へのリフティングを行う際、衝突判定は新しく追加されたリンク $(m+1)$ に対してのみ行われる。先行する $m$ 本のサブチェーンの妥当性は、前ステージの到達可能ワーク自体の性質として継承されるため、全チェーンの衝突チェックを繰り返す必要がなくなる。
4. 投影: リフトされた多様体の有効な部分集合を前方投影することで、次のイテレーションのための新しい到達可能ワークスペース $R^{(m+1)R}$ を生成する。

2.2 分岐整合的連結性（Branch-Consistent Connectivity）

本手法の重要な要素は、逆運動学（IK）の分岐整合性を維持することである。平面 2R サブチェーンにおいて、IK 解は一般に、ヤコビ行列の行列式がゼロとなる特異点によって隔てられた2つの分岐（エルボーアップとエルボウドーン）を持つ。

• ヤコビアン・ラベリング: ワークスペース内の各点は、ベースとなる 2R サブチェーンのヤコビ行列行列式 $\det(J)$ の符号を保持する。
• 連続性制約: グラフ構築（例：A* 探索）において、縮小されたマニフォールド上の隣接ノードは、$|\det(J_a) - \det(J_b)| < \epsilon$ である場合にのみ接続される。
• 効果: この制約により、プランナーは（$\det(J) \approx 0$ となる衝突のない特異点を通過する場合を除き）、IK 分岐間（例：エルボーアップからエルボウドーンへ）を不連続にジャンプすることを防ぐ。これにより、再構成された軌道が元の C-space において運動学的に連続であることが保証される。

2.3 経路再構成

最終的な縮小マニフォールド $M_{red} = R^{(n-1)R} \times S^1$ 上で経路が見つかったら、保存された $\det(J)$ ラベルと整合する IK 解を通じて、各状態をリフトすることで、完全な $nR$ 軌道を再構成する。

3. 主な貢献

• ワークスペース中心の分解: C-space の部分集合を潰す商空間（quotient-space）の手法とは異なり、本手法は、非冗長サブチェーンの障害物制約付き到達可能ワークスペースを通じて、冗長な方位ファイバーを介して縮小表現を構築する。
• 早期の不可能性検出: 本フレームワークは、最小の非冗長ステージ（2R）において実現可能性の必要条件を提供する。もし目標が 2R ワークスペース内で到達不能であれば、アルゴリズムは即座に終了し、冗長な DOF を導入する前の計算リソースを節約できる。
• 低減された衝突計算量: 前のステージからの衝突フリーな妥当性を継承することにより、本手法は高次元 C-space の障害物幾何構造を明示的に構築することを回避する。衝突判定は、各リフティングステージにおいて新しく追加されたリンクに対して局所的に行われる。
• 分岐整合的プランニング: ヤコビ行列の行列式を連続的な分岐ラベルとして用いることで、プランナーは IK 解のトポロジカルな構造をナビゲートでき、不連続な自己運動マニフォールド間の偽の遷移を防ぎつつ、特異点を滑らかに通過することを可能にする。

4. 実験結果

著者らは、2つの平面マニピュレータを用いてフレームワークを評価した：

1. 3R マニピュレータ: 2R ポジショニング・サブチェーンと1つの冗長な末端リンクを持つ、最小限の冗長システム。プランナーは縮小空間 $R^{2R} \times S^1$ 上で軌道を正常に計算した。
2. 5R マニピュレータ: 多角形障害物を持つ高次元システム。フレームワークは、フル $T^5$ 構成空間を構築することなく、4つのリフティングステージ（$R^{2R} \to R^{3R} \to R^{4R} \to R^{4R} \times S^1$）を通じて到達可能性情報を再帰的に伝播させることで、スケーラビリティを実証した。

知見:

• 本手法は、リフティングの各ステージにおいて衝突フリーの連結構造を正常に保持した。
• 得られた軌道は、元の構成空間において連続であり、自己運動マニフォールドのトポロジカルな制約を遵守していた。
• プリプロセッシング後の縮小マニフォールド・グラフ上で探索が行われるため、直接的な C-space 推論と比較して計算複雑性が大幅に削減された。

5. 意義と主張

本論文は、ワークスペース・ファイブレーション（workspace fibration）が、特定のクラスの冗長アームに対してフルスペース・プランニングに代わる実行可能な選択肢であることを主張している。その意義は以下の点にある：

• スケーラビリティ: フル C-space ではなく、縮小されたタスクに適合したマニフォールドで動作することにより、完全なプランニングにおける次元の呪いに対処している。
• 完全性: サンプリングベースの手法には欠けている、完全なプランニングの理論的保証（経路が存在すれば見つけ、存在しなければ不可能性を証明する）を保持している。
• 効率性: プリプロセッシング（ワークスペース構築）と軌道探索を分離することで、混雑した環境における効率的なプランニングを可能にしている。

著者らは、現在の研究は平面マニピュレータに焦点を当てているものの、このフレームワークは、タスク誘起の葉層構造（foliations）と構成空間のファイバー型分解を組み合わせるための幾何学的なテンプレートを提供すると述べている。今後の課題として、これらを空間マニピュレータや高次元タスクへと拡張することが挙げられている。