把持計画とフォースクロージャ

把持計画とは何を解く問題か

ロボットが対象物をつかむとき、グリッパをどこにどう当てれば「落とさず・滑らせず・回転させず」保持できるかを決めるのが把持計画（グラスプ合成）です。人間は無意識に行いますが、ロボットにとっては、対象形状・接触点・摩擦・指の力配分が絡む力学の最適化問題になります。素朴には「はさめば持てる」と思えますが、置き方や外力によっては簡単に滑り落ちるため、「どんな外乱が来ても保持が破れない」ことを保証する数学的な条件が必要になります。その中心概念がフォースクロージャとフォームクロージャです。

横にスクロール

把持を力学的に扱う出発点は、接触点で対象に加えられる力とモーメントを一つのベクトルにまとめたレンチ（wrench＝並進力3成分＋モーメント3成分の6次元ベクトル）です。各指の接触が生む個々のレンチを合成し、その合成が任意の外乱レンチを打ち消せるかどうかを問うのが、把持安定性の解析の骨格になります。手先で力を扱う枠組みは力制御とコンプライアント制御と地続きで、把持は「接触状態でどんな力の集合を生成できるか」を静力学的に突き詰めた問題だと捉えると見通しが良くなります。

摩擦円錐：接触点が出せる力の範囲

各接触点が対象へ加えられる力は無制限ではありません。指は面を押す（垂直方向・法線方向）ことはできても引っ張ることはできず、接線方向の力は摩擦の範囲内に限られます。これを表すのがクーロン摩擦則です。垂直方向の押し込み力を f_n、静止摩擦係数を μ とすると、接線方向の摩擦力 f_t は |f_t| ≤ μ f_n の範囲でしか出せません。

この制約を力ベクトル空間で図示すると、接触面の法線を軸とし、半頂角が arctan(μ) の円錐になります。これが摩擦円錐です。円錐の内側にある力ベクトルなら滑らずに加えられ、円錐の外に出る（接線成分が大きすぎる）と接触点が滑ります。

摩擦円錐（1接触点が滑らずに出せる力の集合）:

  法線方向の押し込み f_n ≥ 0         （引っ張りは不可）
  接線方向の摩擦    |f_t| ≤ μ f_n    （クーロン摩擦則）
  ⇒ 円錐の半頂角 α = arctan(μ)

  μ が大きい（ざらざら）ほど円錐は広がり、
  μ = 0（つるつる）だと法線方向の1本の線に潰れる

摩擦円錐は連続的な集合なので、そのまま扱うと解析が非線形になります。実用上は、円錐の側面上に m 本（典型的には4〜8本）の力ベクトル（生成子）を等間隔に並べ、それらの非負結合で円錐を近似する多面体錐（線形化摩擦円錐）にします。こうすると、後段の把持安定性判定が線形計画・凸包の問題に帰着し、計算が扱いやすくなります。近似の本数を増やすほど真の円錐に近づく代わりに計算量が増える、というトレードオフです。

フォースクロージャとフォームクロージャ

各接触点の摩擦円錐が決まると、その円錐内の力が対象に生むレンチの集合が求まります。全接触点についてこのレンチ集合を足し合わせた（凸包をとった）ものをグラスプレンチ空間と呼びます。ここで把持安定性の中心的な条件が定義されます。

フォースクロージャとは、グラスプレンチ空間（各接触の摩擦円錐が張るレンチの凸錐）が6次元レンチ空間の原点を内部に含む状態を指します。原点を内部に含むということは、どの方向の外乱レンチに対しても、それを打ち消す反対向きのレンチを接触力の適切な配分で必ず生成できる、という意味です。つまり「どんな向き・大きさの外力・外モーメントが来ても、指の押し込み力だけで抑え込める」保持が成立します。摩擦を積極的に利用して少ない指数で安定把持を作れるのがフォースクロージャの利点です（3次元剛体を点接触＋摩擦で確実に固定するには最低3本が必要で、平行グリッパの2本把持は接触面まわりのねじれ摩擦や局所的な平面性に助けられて成立します）。

一方フォームクロージャは、摩擦をまったく仮定せず（μ=0）、接触点の幾何拘束だけで対象を完全に固定できる状態です。摩擦なしでは各接触点は法線方向の力しか出せないため、あらゆる方向の運動を止めるには多くの接触点が必要になります（平面で最低4点、3次元剛体で最低7点が理論値）。フォームクロージャはフォースクロージャより厳しい条件で、フォームクロージャが成立すれば摩擦の有無に関わらず対象は動けません。

両者の関係は包含的です。フォームクロージャはフォースクロージャの十分条件であり（摩擦ゼロで固定できるなら、摩擦があればなおさら固定できる）、逆は成り立ちません。実機のロボットハンドは接触面の摩擦を活かせるため、通常はフォースクロージャを満たす把持を目標にします。ただし摩擦係数 μ の推定は湿り・汚れ・材質で大きくばらつくため、μ を保守的に小さく見積もった上でフォースクロージャを確保するのが安全側の設計になります。

把持品質指標：どの把持が「より良い」か

フォースクロージャは成否の二値判定ですが、成立する把持の中でも安定性には優劣があります。これを連続値で測るのが把持品質指標です。もっとも代表的なのが、グラスプレンチ空間の凸包の表面から原点までの最短距離（Ferrari-Canny指標、しばしば ε 指標と呼ばれる）です。

把持品質（ε 指標）の考え方:

  Q = min over 方向 u  ( 凸包の境界が u 方向で原点から離れている距離 )
    = 原点から凸包表面までの最短距離

  Q > 0  ⇔ 原点が凸包の内部にある ⇔ フォースクロージャ成立
  Q が大きいほど、最悪方向の外乱にも余裕をもって耐えられる良い把持

この指標は「最悪の方向から来る単位外乱に、どれだけの力の余裕をもって対抗できるか」を表します。凸包が原点を余裕をもって囲んでいれば Q は大きく、原点が凸包の境界ぎりぎりにあれば Q は小さく、原点が凸包の外に出れば Q ≤ 0（フォースクロージャ不成立）です。ほかにも、凸包の体積（平均的なロバスト性）や、各指に必要な接触力の最小化（省エネルギー・低押し込み）を測る指標などが目的に応じて併用されます。

対象形状からの把持候補生成

安定性の判定基準（フォースクロージャ・品質指標）が定まったら、次は「そもそもどこをつかむか」という候補を対象形状から大量に生成し、その中から最良を選びます。古典的な把持合成のパイプラインは次の流れです。

把持合成のパイプライン（サンプリングベース）:

  1. 対象の形状取得    : メッシュ／点群／プリミティブ形状で表現
  2. 接触点候補の生成  : 表面から接触点の組をサンプリング
                        （平行グリッパなら対向する2面の点ペア）
  3. 力学的評価        : 各候補の摩擦円錐→レンチ空間→フォースクロージャ判定
  4. 品質指標で採点    : 成立した候補を ε 指標などでランク付け
  5. 運動学的実現性    : 到達姿勢・干渉なしをIK/衝突判定で確認
  6. 最良把持を選択・実行

候補生成の戦略はいくつかあります。対象を箱・円柱・球などの基本形状（プリミティブ）に分解し、各プリミティブに定石の把持（円柱なら側面を挟む、球なら包む）を割り当てる形状ベースの手法は、探索空間を大幅に絞れます。一方、対象表面から接触点ペアをランダムに多数サンプリングし、片端からしらみつぶしに品質を評価するサンプリングベースの手法は、複雑形状にも一般に適用できる代わりに計算量が増えます。近年はこの評価を学習で置き換え、点群やRGB-D画像から把持位置と品質を直接回帰・分類するロボットの物体検出と把持計画のデータ駆動アプローチが主流になりつつありますが、その学習の教師信号や評価指標の根底には本稿のフォースクロージャ・品質指標があります。

見落としやすいのが運動学的実現性です。力学的に最良の把持でも、その姿勢へグリッパが到達できなければ意味がありません。候補選定の最後には、目標の把持姿勢に対して逆運動学が解けるか（順運動学と逆運動学）、途中で対象や周囲と干渉しないか、特異姿勢に陥らないか（ヤコビ行列と操作性）を必ず確認します。把持計画は「力学的に安定な把持の探索」と「その把持を実現するアームの運動計画」という二つの問題が接続して初めて実機で動く、という点が実務上の要になります。

まとめ

把持計画は、対象をどこにどうつかめば外乱に耐えて保持できるかを、接触点の力学から数学的に決める枠組みです。要点は、(1) 接触点が対象に加える力とモーメントを6次元のレンチとして扱い、各接触はクーロン摩擦則が定める摩擦円錐の範囲でしか力を出せないこと、(2) 全接触のレンチが張る凸錐（グラスプレンチ空間）が原点を内部に含めばフォースクロージャが成立し、どんな外乱も相殺できること、(3) 摩擦を仮定しないフォームクロージャはより厳しい幾何拘束であり、フォースクロージャの十分条件になること、(4) 成立する把持の優劣は凸包から原点までの最短距離（ε 指標）などの品質指標で数値化し、対象形状からサンプリングした多数の候補をランク付けして最良を選ぶこと、の4点です。この静力学的な安定性の理論は、平行グリッパから多指ハンド、そして学習ベースの把持検出に至るまで、ロボットが物をつかむあらゆる場面の判断基準を支える土台になります。