Contact-Aware Planning and Control of Continuum Robots in Highly Constrained Environments

Aedan Mangan, Kehan Long, Ki Myung Brian Lee, Miheer Potdar, Nikolay Atanasov, Tania K. Morimoto · 2026

Read Contact-Aware Planning and Control of Continuum Robots in Highly Constrained Environments by Aedan Mangan, Kehan Long, Ki Myung Brian Lee, Miheer Potdar, Nikolay Atanasov, Tania K. Morimoto (2026) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2604-15638.txt.

Introduction

Mangan and five colleagues present contact-aware planning and control for continuum robots in tight fragile spaces such as blood vessels, where contact is often unavoidable. Their planner scores contact quality, penalizing hazardous interactions while allowing benign ones, and yields feasible trajectories plus contact-aware Jacobians for closed-loop control. Hardware trials on patient-scan anatomical models reached every target with no dangerous tip contact, at tracking errors near 1 to 2 millimeters.

Catalog record

CREATORAedan Mangan, Kehan Long, Ki Myung Brian Lee, Miheer Potdar, Nikolay Atanasov, Tania K. Morimoto
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE72985
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2604.15638

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Contact-Aware Planning and Control of Continuum Robots in Highly Constrained Environments Thanks: 1 Department of Mechanical and Aerospace Engineering, University of California San Diego, San Diego, CA 92093, USA (email: [email protected]) Thanks: 2 SceniX Inc, New York, NY 10011, USA Thanks: 3 Department of Electrical and Computer Engineering, University of California San Diego, San Diego, CA 92093, USA Thanks: 4 Department of Surgery, University of California San Diego, San Diego, CA 92093, USA Thanks: This article has supplementary downloadable material (Supplementary Video S1) available, provided by the authors. Aedan Mangan, Kehan Long, Ki Myung Brian Lee, Miheer Potdar, Nikolay Atanasov, Tania K. Morimoto Abstract Continuum robots are well suited for navigating confined and fragile environments, such as vascular or endoluminal anatomy, where contact with surrounding structures is often unavoidable. While controlled contact can assist motion, unfavorable contact can degrade controllability, induce kinematic singularities, or introduce safety risks. We present a contact-aware planning approach that evaluates contact quality, penalizing hazardous interactions, while permitting benign contact. The planner produces kinematically feasible trajectories and contact-aware Jacobians which can be used for closed-loop control in hardware experiments. We validate the approach by testing the integrated system (planning, control, and mechanical design) on anatomical models from patient scans. The planner generates effective plans for three common anatomical environments, and, in all hardware trials, the continuum robot was able to reach the target while avoiding dangerous tip contact (100% success). Mean tracking errors were 1.9 ± 0.5 1.9\pm 0.5 mm, 1.2 ± 0.1 1.2\pm 0.1 mm, and 1.7 ± 0.2 1.7\pm 0.2 mm across the three different environments. Ablation studies showed that penalizing end-of-continuum-segment (ECS) contact improved manipulability and prevented hardware failures. Overall, this work enables reliable, contact-aware navigation in highly constrained environments. I Introduction Continuum or soft robots have become increasingly popular in applications, such as vascular intervention, endoscopy, and inspection in confined spaces [ 6 , 11 , 33 ] , which require navigating through tight, deformable, and fragile environments. In these settings, contact between the robot and the environment is not merely a disturbance to avoid but often a necessary part of successful motion. However, while controlled contact can facilitate navigation, unfavorable contact can degrade controllability, induce kinematic singularities, or cause irreversible damage to surrounding structures. Fig. 1: Overview of the proposed contact-aware planning and control framework. (a) Patient imaging data and user-defined target location serve as inputs to (b) the contact-aware motion planner, which penalizes hazardous interaction and permits benign contact. (c) The feedback controller executes the planned trajectory using closed-loop control with minimal sensing requirements. The approach was validated across multiple environments derived from anatomical scans, achieving successful navigation in all three aortic arch types (see Supplementary Video S1). Prior planning methods tend to either avoid obstacles entirely or deliberately exploit contact to facilitate navigation [ 29 , 12 , 26 , 18 , 38 , 15 , 23 , 31 , 37 , 13 , 8 ] . These works advanced continuum robot deployment in constrained settings but do not (i) distinguish between benign and hazardous contact during planning, or (ii) integrate contact-aware, closed-loop control for reliable hardware execution. If the planned trajectory induces singularities or unstable contact modes, even sophisticated feedback control cannot guarantee successful navigation. Control strategies for continuum robots range from model-based that leverage kinematic or dynamic models to model-free (or learning based) that adapt the control using sensor feedback [ 4 , 14 , 42 , 40 ] . These controllers require kinematically feasible, contact-aware trajectories with favorable contact configurations. Unfavorable contact may be application specific (e.g., vascular injury during a surgery or damage to a camera during inspection). As a representative use case, we focus on autonomous navigation of the aortic arch during mechanical thrombectomy, an endovascular procedure used to remove blood clots from cerebral vessels during an ischemic stroke. When clinicians treat ischemic stroke via mechanical thrombectomy, they rely on controlled contact between the body of the catheter and the environment, while deliberately avoiding contact at the tip due to the risk of vessel perforation or dissection. Mechanical thrombectomy consists of three primary stages: (1) navigation around the aortic arch into the target vessel, (2) traversal of the selected vasculature using a guidewire (or soft growing robot as proposed in [ 25 ] ), and (3) clot removal from the brain. This work focuses on stage (1), as automating navigation around the aortic arch has significant potential to expand access to care and reduce procedure time in anatomically difficult cases, thereby minimizing neurological damage from prolonged ischemia [ 22 , 36 ] . To enable robust navigation in environments where contact is necessary, we introduce a unified, contact-aware planning and control approach for continuum robots that regulates contact between the robot and environment. Our contributions are summarized as follows. • Contact-Aware Planner: We provide a search-based planning algorithm for continuum robots that evaluates contact quality during planning, penalizing hazardous interactions while permitting benign contact. The planner incorporates (1) contact-aware robot transitions that ensure kinematic feasibility of the trajectory, and (2) anatomy-specific transition costs and a heuristic function that guide the selection of actions that mitigate contact-induced singularities and preserve robot manipulability during navigation. To enable realistic planning times, we introduce a task-space partitioning strategy that informs contact costs, enables a dynamic action-space, and informs a task-space based heuristic to guide the search near the goal. • Control: We propose a trajectory tracking controller that requires only tip pose feedback. The controller leverages three things from the contact-aware planner: (1) precomputed tip pose waypoints, (2) joint input commands, and (3) contact-aware Jacobians to enable accurate execution with minimal sensing. • Integrated System Validation: We demonstrate the complete framework using a multi-segment continuum robot, whose mechanical design enables navigation through diverse environments. We validate the system in aortic arch models created from patient scans, and, to the best of our knowledge, are the first to autonomously navigate type I, type II, and type III aortic arches while avoiding distal tip contact, thereby reducing the risk of vessel injury. II Related Work II-A Planning for Continuum Robots Motion planning for continuum robots spans both contact-agnostic and contact-aware approaches. Contact-agnostic planners generate collision-free paths using simplified kinematic models (combined with search or sampling based planning) [ 29 , 12 , 26 , 18 , 38 , 32 , 1 ] . These methods are computationally efficient but often assume minimal or no contact with the environment. Contact-aware motion models better capture robot-environment interaction during planning but require more computation time. Recent work incorporates novel heuristics, topology informed planning, and sampling based methods to reduce calls to the contact-aware motion model [ 31 , 35 , 37 , 34 , 39 ] . While these methods account for contact, they do not distinguish between benign and unfavorable contact, and, when deploying on real systems, do not incorporate closed-loop control to compensate for motion model errors. II-B Control During Environment Interaction Control strategies have leveraged sensing to adapt continuum robot motion during deployment and to accommodate contact with the environment. Model-based compliance control enables the robot to adapt its shape during insertion to comply with the environment [ 14 , 2 ] . Safety-constrained approaches use control barrier and Lyapunov

Read the complete text