Track manipulation, locomotion and embodied systems.
Search papers, labs, and topics across Lattice.
This paper introduces PI-UDF, a physics-informed unified differentiable framework for predicting pairwise inter-arm collision distances in multi-robot manipulation. By combining analytical forward kinematics with learnable geometry embeddings and a residual network, PI-UDF directly estimates distances from robot configurations, enabling integration into gradient-based nonlinear MPC. The framework achieves safe, high-speed close-proximity manipulation by employing quota-driven boundary mining and an asymmetric penalty to prioritize false-safe errors, as validated on a dual-Franka platform.
A single differentiable model now predicts inter-arm collision distances for real-time, gradient-based multi-robot motion planning, overcoming the limitations of traditional geometric checkers and conservative proxies.
Close-proximity multi-arm manipulation requires collision models that are both geometrically accurate and differentiable enough for real-time optimization. Classical geometry checkers provide reliable distances but are difficult to use inside gradient-based model predictive control, while conservative proxy models can restrict tightly coupled motion. We present PI-UDF, a physics-informed unified differentiable framework for body-to-body collision distance prediction between articulated robots. PI-UDF combines analytical forward kinematics with learnable link-geometry embeddings and a shared residual network to predict pairwise inter-arm distances directly from robot configurations. To improve safety-critical fidelity, we combine quota-driven boundary mining with an asymmetric boundary-crossing penalty that emphasizes false-safe sign errors near the collision boundary. The learned distance field is integrated into nonlinear MPC as a differentiable inter-arm clearance term. We validate the framework on a real dual-Franka platform through high-speed close-proximity 14-DoF dual-arm swapping, sustained single-arm dynamic evasion, and dynamic-evasion planning configurations with frozen, predicted, and target-switching treatments of the moving arm. Hardware experiments and offline Drake/FCL replay show that PI-UDF provides a differentiable inter-arm clearance estimate suitable for closed-loop collision-aware collaborative robot motion generation.