Prototype Distance-Field Safety Layer
Implementation & benchmark of arXiv:2608.00600 — Grasp Execution Without a Planner: Configuration-Space Grasp Distance Fields with Certified Safety & Guaranteed Quality
Source paper: Grasp Execution Without a Planner: Configuration-Space Grasp Distance Fields with Certified Safety & Guaranteed Quality arXiv:2608.00600 ⓘ · analyzed Aug 31, 2026
AI-generated research hypothesis, automatically tested. Not peer-reviewed.
Idea description
Store a finite library of successful robot configurations or action-conditioned waypoints and construct a smooth soft minimum of their distances. Use the negative distance gradient as a structured action prior, add a learned residual policy, and pass the combined action through a quadratic-program safety layer. This gives a neural controller an explicit attraction basin toward demonstrated solutions while preventing violations of known state constraints.
Formulas
Mathematical statement
For a current configuration \(q\in\mathbb{R}^d\) and finite prototype set \(\mathcal{Q}=\{q_i\}_{i=1}^N\), define distances \(d_i(q)=\|q-q_i\|_2\) or a weighted norm \(d_i(q)=\|L(q-q_i)\|_2\), where \(L\) is a fixed positive-definite metric factor. The soft minimum is \(D_\rho(q)=-(1/\rho)\log\sum_{i=1}^N\exp[-\rho d_i(q)]\), with inverse temperature \(\rho>0\). It satisfies \(\min_i d_i(q)-\log N/\rho\le D_\rho(q)\le\min_i d_i(q)\), so increasing \(\rho\) makes the field approach the nearest-prototype distance with a known error. Its gradient is \(\nabla D_\rho(q)=\sum_i w_i(q)\nabla d_i(q)\), where \(w_i=\exp(-\rho d_i)/\sum_j\exp(-\rho d_j)\); use \(u_{\mathrm{proto}}=-k\nabla D_\rho\). The paper's grasp-quality primitive is the min-weight linear program \(\ell^*(q)=\max_{a\in\mathbb{R}^m,\ell\in\mathbb{R}}\ell\ \mathrm{s.t.}\ W(q)a=0,\ \mathbf{1}^{\top}a=1,\ a\succeq\ell\mathbf{1}\), with \(W(q)\) the wrench matrix, \(a\) wrench weights, and \(\bar{\ell}^*(q)=m\ell^*(q)\). For general learned control, replace this grasp-specific quality by differentiable task constraints \(h_j(s)\ge0\). The safety filter solves \(\min_{u,\delta}\frac12\|u-u_{\mathrm{raw}}\|_2^2+p\delta^2\) subject to \(\nabla h_j(s)^{\top}u+\alpha_j h_j(s)\ge0\) and \(\nabla V(s)^{\top}u+cV(s)\le\delta\), where \(u_{\mathrm{raw}}=u_{\mathrm{proto}}+u_\theta(s)\), \(V\) is distance to the task goal, \(\alpha_j,c,p>0\), and \(\delta\ge0\) is the obstruction slack.
Implementation notes
Integrate this as the action head of a low-dimensional robot policy, before the robot's joint-velocity or acceleration command is sent to the simulator. First collect \(N\) successful joint configurations or short-horizon goal-conditioned waypoints \(q_i\), normalize each joint by its range, and choose diagonal \(L\) so every coordinate has comparable scale. At state \(s_t\), let the neural network output a residual action \(u_\theta(s_t)\). Compute all prototype distances \(d_i=\|L(q_t-q_i)\|_2\), stable softmax weights \(w_i=\operatorname{softmax}(-\rho d_i)\), and \(u_{\mathrm{proto}}=-k\sum_iw_iL^\top L(q_t-q_i)/(d_i+10^{-6})\). Set \(u_{\mathrm{raw}}=u_\theta+u_{\mathrm{proto}}\). Define analytic barriers such as joint limits \(h(q)=q_{\max}-q\), \(q-q_{\min}\), obstacle signed distance minus clearance, and workspace bounds. Estimate their Jacobians analytically or with automatic differentiation, then solve the stated small QP and execute its clipped solution. During training, backpropagate through the QP when a differentiable QP solver is available; otherwise use the QP output for rollouts and penalize \(\|u-u_{\mathrm{raw}}\|^2\), constraint violations, and slack \(\delta\). The mathematical quantities computed exactly are the log-sum-exp field, its \(\log N/\rho\) approximation bound, prototype gradient, and barrier inequalities. Prototype coverage, obstacle-distance accuracy, and Jacobian noise should be estimated empirically. Begin with a 2-D or 7-DoF reaching task with clutter, comparing an MLP policy, MLP plus nearest-prototype attraction, and MLP plus attraction plus QP. Measure success rate, collision and joint-limit violations, mean \(\delta\), action correction magnitude, and success at equal environment steps. The method succeeds if it improves completion and safety without excessive QP corrections or exceeding the control-period budget.
Verification
This idea has not been verified yet.
Verification happens in two stages: Stage 1 — a mechanism check on a toy system confirms the claimed mathematical phenomenon reproduces; Stage 2 — a benchmark implements the idea on a real (small) neural network task and compares it against a tuned baseline over 8 paired seeds with a permutation test.
Artifacts
Artifacts unavailable.