技術要約：Compliant Sphere Lattice Contact (CSLC)

問題提起

ロボット工学における接触プランニングは、計算効率と物理的精度の間の根本的なトレードオフに直面している。現代的なプランニングフレームワーク（例：cuRobo、VAMP）は、ロボットのリンクに対して球体ベースの表現を用いる傾向を強めている。これは、衝突判定が極めて高速であり、解析的な符号付き距離クエリ、および完全微分可能な幾何学を可能にするためである。しかし、これらの表現に適用される標準的な接触モデルは、**点接触（point contact）**に依存している。

点接触モデルは本質的に接触パッチ領域を持たないため、以下の要素を捉えることができない：

• 回転剛性
• 摩擦モーメント
• 圧力分布

その結果、点接触モデルは反力（reaction forces）を無限に小さな位置に局在化させてしまい、ポーズ誤差に対して非常に脆弱で不安定な把握を生み出す。これを補うために、プランナーは摩擦係数を人工的に膨張させたり、過剰なグリップ力を指令したりすることが多いが、これは巧みな操作（dexterous manipulation）に必要な微細なメカニズムを抑制し、壊れやすい物体を損傷させるリスクがある。一方で、メッシュベースの分散接触モデル（例：Pressure Field Contact）はより高い忠実度を提供するが、計算コストが高く、球体プリミティブのような微分可能性や速度を欠いている。

手法：Compliant Sphere Lattice Contact (CSLC)

著者らは、球体表現上でネイティブに動作する分散接触モデルである**Compliant Sphere Lattice Contact (CSLC)**を導入する。CSLCは、球体プリミティブの速度と、メッシュベースの手法に特有の物理的忠実度を統一するものである。

1. 運動学モデル

ロボットのインターフェースは、基礎となる剛体（rigid body）に接続された表面球体の**コンプライアント・ラティス（柔軟な格子）**としてモデル化される。

• 状態変数： 各表面球体 $i$ は、静止位置 $p_i$ と変位ベクトル $\delta_i$ を持つ。球体の中心は $q_i = p_i + \delta_i$ へ移動し、接触半径 $r_i$ は固定される。
• 分解： 変位は、剛体に対する法線方向の圧縮（$\delta_{n,i}$）と接線方向のせん断（$\delta_{t,i}$）に分解される。

2. 力の定式化

各表面球体に作用する4つの異なる力が、変形と接触力を決定する：

• アンカー・スプリング（Anchor Springs）： 各球体をその静止位置に接続し、法線剛性 $k_a$ と接線比 $\rho$ を用いて変位に抵抗する。
• 横方向結合（Lateral Coupling）： 隣接する球体は、剛性 $k_\ell$ を持つ横方向のスプリングによって接続されている。このメカニズムは、接触荷重をラティス全体に分散させ、連続的な圧力場の離散的な近似として機能する（流体弾性モデルに類似）。
• 接触力（Contact Force）： ラティスの球体 $i$ が対象要素 $j$（球体またはサンプリングされたメッシュ点）に貫入する場合、Hertz型のコンプライアンス則が力を生成する：
  $$f_{contact} = k_c A_j s_{ij} \phi_{eff}^{3/2} \hat{n}_{face,j}$$
  ここで、$\phi_{eff}$ は貫入深さ、$A_j$ は面積要素、$s_{ij}$ は全力が接触面上で正しく積分されることを保証する局所重みである。
• プレスライディング摩擦（Pre-sliding Friction）： 摩擦は、滑り速度ではなく接線方向の変位 $\delta_{t,i}$ に紐付けられている。このモデルは、微小なせん断における弾性スプリング挙動と、大きなせん断におけるクーロン飽和（$\mu f_{n,i}$）の間を補間する弾塑性摩擦則を使用しており、ブリッスル（毛状突起）のたわみのための別個の状態変数を必要とせずに、プレスリップ弾性を捉える。

3. ソルバー

システムは、各タイムステップにおいて4つの力のバランスをとることで、ラティスの変位場 $\delta$ を解き、**準静的平衡（quasistatic equilibrium）**を実現する：
$$f_{anchor} + f_{lateral} + f_{contact} + f_{friction} = 0$$
これは、各球体間で独立しており、自然にGPUで並列化可能な、減衰付きヤコビ・スイープ（damped Jacobi sweep）を用いて解かれる。このソルバーはホストのシミュレータに依存せず、著者らはこれをMuJoCo（メッシュサンプリング）とPosition-Based Dynamics (PBD) パイプラインの両方に統合した。

主な貢献

1. 球体上の分散接触： CSLCは、球体プリミティブの速度と、パッチレベルの忠実度を実現するための物理的忠実度を統一する。これにより、パッチレベルの忠実度を得るためのメッシュ表現に代わる選択肢を、球体ベースの幾何学的表面上で直接生成する。
2. 物理的忠実度： このモデルは、従来の球体ベースの手法では利用できなかった物理特性、具体的には回転剛性、摩擦モーメント、および圧力分布を捉えるためのステップを踏んでいる。
3. 微分可能性： 定式化は、単純なパス（$\max(\cdot, 0)$ クランプの平滑化を待つ必要があるが）を用いて微分可能な形式へと設計されており、勾配ベースのプランニングや制御に適している。
4. ソルバーの統合： 著者らは、準静的なラティス・ソルバーが、物理エンジンを完全に刷新することなく、既存の剛体シミュレータに効率的に統合できることを示している。

実験結果

著者らは、2つの独立したソルバー（MuJoCoおよびPBD-R）を用いてCSLCを検証し、以下の知見を得た：

• ラティスの変形： 点荷重下での $15\times15$ の平面ラティスの制御テストにおいて、本モデルは横方向結合が荷重を分散させることを正常に示した。変形は特性長 $\ell = h\sqrt{k_\ell/k_a}$ で指数関数的に減衰し、モデルが、パッチ幅が剛性比によって制御されるスクリーンド・ポアソン系として振る舞うことを確認した。
• 安定した持ち上げ（クーロン限界）： 球体やボックスに対するフラットおよびドーム型パッドを用いた把握実験において、CSLCは理論的なクーロン滑り限界（$F_n \ge mg/2\mu$）の直上で安定した持ち上げを可能にした。分散パッチにより、ロボットは点接触モデルが同等の安定性を達成するために必要とする力よりも低い力で、確実なグリップを維持することができた。
• 回転安定性： 回転摂動を受けた長方形の「本」の把握実験において、標準的な剛体点接触モデルは失敗し、物体が大きな傾きと滑りを伴って把握から脱落した。対照的に、CSLCは物体を安定させることに成功した。傾きを $\pm 0.7$ 度以内に抑えたのである。これは、分散パッチがオフアキシス（軸外）のコンプライアント・スプリングを通じて復元トルクを生成し、点接触が欠いている回転剛性を回復させる一歩を踏み出したことを示している。

意義と主張

本論文は、CSLCを、球体プリミティブの計算速度とメッシュベースの手法の物理的精度の間のギャップを埋めるための重要なステップとして位置づけている。著者らは、CSLCが以下を可能にすると主張している：

• 優しい把握（Gentle Grasping）： 滑りの限界直上の力で物体を把握することを可能にし、壊れやすい物体を損傷させる過剰なグリップ力を回避する。
• 堅牢な操作： 人工的に膨張させた摩擦係数に頼ることなく、回転摂動に対する把握の安定性を向上させる。
• 将来の可能性： 現在の実装は準静的であり、点接触の約3倍の実行コストがかかるものの、著者らはこのモデルがモデルベースの操作および学習ベースの手法にとって不可欠であると主張している。彼らは、今後の課題として、ソルバーのコンディショニングを改善して実行時間の差を縮めること、動的な衝撃への拡張、および勾配ベースの最適化のために接触則を平滑化することなどを挙げている。

著者らは現在の範囲について謙虚な姿勢を保っており、現在の実装は、スキン（皮膚）の平衡が1タイムステップ内に完了できない高速な衝撃時には破綻すること、また、現在の実装は「完全微分可能なリアルタイム接触モデル」に向けた「初期のステップ」であることを認めている。