cs.RONov 19, 2026

Close&Safe: Maximal Task Preservation for Redundant Manipulators via C-Space Boundary Detour

Authors: Abhigyan Singh, Manthan Goyal, Fares Abu-Dakka, Ravi Prakash

Organizations: Indian Institute of Science (IISc), Bengaluru, India. · Indian Institute of Technology Ropar, Rupnagar, India. · New York University Abu Dhabi, Abu Dhabi, UAE.

Abstract

Contact-rich manipulation such as wiping, polishing and surface inspection specifies the task as a continuous end-effector trajectory rather than a goal pose. When an obstacle absent from the planning model intersects it, conventional planners return a collision-free path that may differ from the nominal throughout, discarding trajectory that was never obstructed. We present Close&Safe (Close to the intended task, Safe from obstacles), which decouples tracking from avoidance: the nominal is followed exactly wherever it remains feasible, and avoidance acts only on the interval where it is not, so tracking is hindered as little as the obstacle allows. On that interval we sample the configuration-space obstacle boundary within a corridor around the nominal, connect the samples into a roadmap, and search it for the detour that deviates least before rejoining the nominal at the earliest feasible configuration. We evaluate across diverse simulated obstacle configurations, physical Franka experiments, and ablations of key algorithmic components. The results demonstrate collision-free trajectory repair with localized task modification, while recovering 52.4-78% in simulation and on hardware.

Figures & tables

Explore similar work

CardsList
  1. A Task-Space Receding Horizon Controller for Fast Collision Avoidance

    Jul 17, 2026Mattia Penzotti, Marco ControzziRobotic ControlConstrained Motion Planning

  2. Coding Agents with Harness for Safe Robot Control

    Sep 17, 2026Bingxin Xu, Yuzhang Shang, Zhen Dong +1Robot SafetyRobotic Manipulation

  3. ToMPC: Task-oriented Model Predictive Control via ADMM for Safe Robotic Manipulation

    Mar 14, 2026Xinyu Jia, Wenxin Wang, Jun Yang +2Safe Robot ManipulationRobotic Manipulation