Constraint Manifold

• 別名: constraint surface
• カテゴリ: Planning & manipulation › Trajectory optimisation
• タグ: motion-planning, configuration-space, constrained-planning, bimanual-manipulation, sampling-based-planning

トレーを水平に保つといった 1 つ以上の等式拘束を満たすロボットのコンフィギュレーションの集合。通常はコンフィギュレーション空間の中の低次元の曲面である。

定義

拘束多様体（constraint manifold）は、等式拘束 F(q) = 0 を満たすすべてのコンフィギュレーション q からなる、コンフィギュレーション空間の部分集合である。典型的な拘束はエンドエフェクター位置姿勢の一部を固定する。カップを立てたまま保つ、ペンをホワイトボードに押し当てておく、ドアが回る間グリッパーでドアハンドルを握り続ける、同じ物体を持つ 2 つの手の間の変換を一定に保つ、といったものである。k 個の拘束式が独立なとき、陰関数定理により、解集合は局所的には n 次元のコンフィギュレーション空間の中の滑らかな (n − k) 次元多様体になる。周りの空間より次元が低いため体積はゼロであり、ランダムにサンプリングしたコンフィギュレーションが拘束を満たす確率はゼロである。

この性質こそが、拘束付きの動作計画を難しくしている。PRM や RRT のようなサンプリングベースのプランナーはランダムなコンフィギュレーションを抽出して直線分でつなぐが、多様体上ではどちらのステップも破綻する。サンプルは多様体に乗らず、曲がった多様体上の 2 点を結ぶ直線分は多様体から外れるからである。拘束付きプランナーはいくつかの主な戦略を用いる。射影法は多様体の外のサンプルを多様体上へ引き寄せ、多くの場合、拘束ヤコビ行列を使ったニュートン反復で行う。継続法やアトラス法は接空間上に局所チャートを作り、それに沿って探索を広げる。緩和法は多様体の周りに小さな許容帯を認め、多様体を体積がゼロでない薄い領域に変える。パラメータ化法は、使える場合には、より少ない自由座標で多様体を直接記述する。たとえば双腕把持で、解析的逆運動学を使って一方のアームの関節からもう一方のアームの関節を計算する。

閉じた運動連鎖では、1 つの剛体を 2 本のアームで持つ場合やパラレルメカニズムも含め、拘束多様体はループが閉じたままになるコンフィギュレーションの集合である。軌道最適化は同じ拘束を、サンプリング元の集合としてではなく、最適化問題の等式拘束として扱う。どちらにとっても多様体の構造は重要である。多様体は関節可動域の限界や異なる逆運動学の分岐によって別々の成分に分かれることがあり、どんな連続的な運動もその間を渡ることはできない。

重要な理由

有用なタスクの多くは拘束を伴う。ふたのない容器を運ぶ、2 本のアームで物体を動かす、ドアや引き出しを開ける、表面に描いたり拭いたりする、といったものである。拘束多様体の体積ゼロの構造を無視するプランナーは、経路を見つけられないか、経由点の間で拘束に違反する経路を返す。そのため、プランナーが多様体をどう扱うかで、その速度と信頼性の多くが説明できる。

主な用途

• 共有する剛体の双腕操作
• ふたのない容器のように、立てたまま保たなければならない物体の運搬
• ヒンジやスライドに沿ったドア、引き出し、バルブの開放
• 閉ループ機構とパラレルロボットの計画
• 書く、拭く、磨くといった、表面上での工具の運動
• 手や足の接触を固定した状態でのヒューマノイドと脚ロボットの計画

実際の使われ方

2 本の 7 関節アームが長い箱を運び、両方のグリッパーが箱をしっかり保持している。合わせたコンフィギュレーション空間は 14 次元だが、両手の間の固定された変換が 6 個の等式拘束を課すため、有効なコンフィギュレーションは 8 次元の拘束多様体上にある。射影ベースの RRT はランダムなコンフィギュレーションをサンプリングし、拘束ヤコビ行列を使ったニュートンステップで多様体上へ引き寄せ、各エッジに沿って小さなステップで衝突と拘束誤差の両方を検査する。解析的逆運動学が使える場合の別の方法では、一方のアームの関節ともう一方のアームの冗長パラメータの上で計画し、2 本目のアームの関節を閉形式で計算するので、どのサンプルも構成上拘束を満たす。チームは、関節可動域の限界付近でそれぞれの方法がどのくらい失敗するかを比較する。そこでは射影でも閉形式解でも有効な答えが得られないことがあるからである。

よくある誤解

• 拘束付きの計画はサンプルを増やせば済む — 多様体の体積はゼロなので、いくつ抽出してもランダムなサンプルが多様体に乗ることはほとんどない
• すべての経由点が拘束を満たせば経路全体も満たす — 有効な 2 つのコンフィギュレーションの間の直線補間は一般に曲がった多様体から外れるので、エッジも検査するか射影する必要がある
• 拘束多様体は 1 つのつながった曲面である — 関節可動域の限界や別々の逆運動学の分岐によって、どんな連続的な運動でもつなげない成分に分かれることがある

知っておくべき人

• 動作計画のエンジニア
• 双腕操作とモバイルマニピュレーションの研究者
• 拘束付きの軌道最適化器を作るエンジニア
• コンフィギュレーション空間を学ぶロボット工学の学生

関連技術

• 射影ベースの拘束付き計画（Projection-Based Constrained Planning）
• アトラスベースの計画（Atlas-Based Planning）
• 拘束ヤコビ行列（Constraint Jacobian）
• ニュートン–ラフソン法（Newton–Raphson Method）
• 陰関数定理（Implicit Function Theorem）

関連用語

• Configuration Space
• Kinematic Redundancy
• Inverse Kinematics
• Rapidly-exploring random tree
• Probabilistic Roadmap
• Graph of Convex Sets

関連プロジェクト

• OMPL: Sampling-based motion planning library powering MoveIt and countless robotics applications
• MoveIt 2: Motion planning framework for ROS 2 robot arms, with kinematics and collision checking
• PyRoki: Modular Python toolkit for kinematic optimization across CPU, GPU, and TPU via JAX
• mink: Python inverse kinematics library built on MuJoCo supporting 20+ robot platforms
• Ruckig: Real-time jerk-constrained time-optimal trajectory generation for robots and machines
• NeuPAN: Real-time end-to-end planner that maps raw lidar points directly to robot actions