Sampling-Based Follow-the-Leader Motion Planning for Manipulator-Mounted Continuum Robots

Chengnan Shentu, Nicholas Baldassini, Oluwagbotemi D. Iseoluwa, Radian Gondokaryono, Jessica Burgner-KahrsUniversity of Toronto https://continuumroboticslab.github.io/sb-ftl-cr-planner/ · 2026

Read Sampling-Based Follow-the-Leader Motion Planning for Manipulator-Mounted Continuum Robots by Chengnan Shentu, Nicholas Baldassini, Oluwagbotemi D. Iseoluwa, Radian Gondokaryono, Jessica Burgner-KahrsUniversity of Toronto https://continuumroboticslab.github.io/sb-ftl-cr-planner/ (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-2605-11618.txt.

Introduction

Shentu and four colleagues present a sampling-based follow-the-leader planner for manipulator-mounted continuum robots. Follow-the-leader motion lets a robot body retrace its tip path through confined spaces, but existing methods assume a fixed base. Their planner jointly considers shape and base pose for robots on fully actuated manipulators. It decouples shape search from base pose, computing the pose through a closed-form construction avoiding iterative optimization online. Tests on 120 simulated paths show zero tip error and 1 point 9 percent mean shape deviation at full success.

Catalog record

CREATORChengnan Shentu, Nicholas Baldassini, Oluwagbotemi D. Iseoluwa, Radian Gondokaryono, Jessica Burgner-KahrsUniversity of Toronto https://continuumroboticslab.github.io/sb-ftl-cr-planner/
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE61827
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

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

Browse the full library · About the Tower of Babel

Full text

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

Sampling-Based Follow-the-Leader Motion Planning for Manipulator-Mounted Continuum Robots Chengnan Shentu, Nicholas Baldassini, Oluwagbotemi D. Iseoluwa, Radian Gondokaryono, Jessica Burgner-KahrsUniversity of Toronto https://continuumroboticslab.github.io/sb-ftl-cr-planner/ Abstract Follow-the-leader (FTL) motion exploits the unique morphology of continuum robots (CRs) to navigate confined spaces by having the body retrace the path of the tip. While extensively studied, existing FTL methods typically assume a fixed base or a single degree-of-freedom insertion mechanism, limiting their applicability to practical systems in which CRs are mounted on robotic manipulators with fully actuated S ​ E ​ ( 3 ) SE(3) base pose. This paper presents a sampling-based motion planner for FTL motion of manipulator-mounted CRs that jointly considers robot configuration and base pose. The key idea is to decouple global shape search from base pose determination by computing the base pose through a closed-form geometric construction, thereby avoiding iterative optimization during online planning. The approach supports general forward models and enables efficient planning by shifting the majority of computation offline. We establish theoretical guarantees including resolution complete shape search and converging tip tracking throughout waypoint traversal and interpolation. Experiments on 120 simulated paths over 3 test classes demonstrate 0% tip error and 1.9% mean shape deviation (w.r.t. robot length) at 100% success rate. We validate the practicality of our approach on a 6-DOF tendon-driven CR mounted on a serial manipulator. Code and visualization available at the project website . Fig. 1 : Overview of our sampling-based follow-the-leader motion planning framework. Offline Library: shapes are precomputed from any forward model. Base Pose Alignment: for each candidate shape (blue), geometric transformations align the robot tip to the current waypoint (green dots) and shape along the target path (orange curve). Fully-actuated SE(3) base poses are shown as coordinate axes. Global Shape Search: the best-matching shape is selected for each waypoint, producing a sparse plan (red to blue gradient indicates progression). Local Interpolation: smooth interpolation between waypoints yields a dense trajectory suitable for deployment, validated in simulation and on hardware. \NoHyper † † * Indicates equal contribution. Correspondence to {c.shentu, nicholas.baldassini}@mail.utoronto.ca . \endNoHyper I Introduction Continuum robots (CRs) are flexible, high-DOF robots inspired by biological structures such as elephant trunks and octopus arms, with promising potential for navigating confined, tortuous spaces inaccessible to rigid-link robots [ 29 ] . Their unique capabilities have led to increasing deployment in minimally invasive surgery [ 5 , 11 ] , industrial inspection [ 33 ] and search-and-rescue operations [ 38 ] . A key motion primitive enabling these applications is follow-the-leader (FTL), where the robot body follows the path traced by its tip during insertion [ 23 ] . FTL motion minimizes lateral forces on surrounding tissue or structures, reducing trauma in surgical procedures and avoiding collisions in cluttered environments. FTL motion planning has been studied extensively for various continuum and soft robot architectures. Early work established the foundational concepts for snake-like robots [ 7 ] . Steerable needles [ 10 ] and vine robots [ 8 ] are designed to operate with FTL motion, achieving excellent results because they naturally extend during deployment. Similar principles have been applied to concentric tube robots (CTRs), where FTL is achieved through selection of suitable tube parameters and coordinated tube extension [ 15 , 14 , 16 , 37 ] . For tendon-driven continuum robots (TDCRs), two main approaches have emerged. The first adds degrees of freedom to the TDCR design itself through extensible segments [ 1 ] , active stiffness modulation [ 27 ] , magnetic actuation [ 21 ] , or a combination such as the interlaced design with extensible segments and internal locking mechanism [ 19 , 34 ] . While effective, these hardware-based solutions are difficult to generalize across applications as the additional mechanisms occupy valuable space that could otherwise accommodate payloads such as sensors, tools, or delivery channels. The second approach addresses the more general case by introducing degrees of freedom at the TDCR base and coordinating them with the CR’s configuration through differential [ 13 ] , heuristic-based [ 22 , 20 ] , or optimization-based inverse kinematics [ 24 , 12 , 36 ] . However, these methods share common limitations. All rely on simplified kinematics such as the piece-wise constant curvature (PCC) model [ 18 ] , which does not accurately capture the behavior of physical TDCRs. Additionally, most employ local solvers or iterative optimization, which can converge to suboptimal solutions in the high-dimensional, nonlinear configuration space of CRs and are sensitive to initialization. Such unpredictability can be a limitation for safety-critical applications where predictable planner behavior is important. These limitations are compounded by a confining assumption shared by nearly all existing methods: the robot base is either fixed in space or constrained to 1-DOF linear insertion. This does not reflect the growing class of practical deployments where continuum robots are mounted on robotic manipulators with full 6-DOF base pose control. In surgical systems, flexible endoscopes have been integrated with robot arms for precise positioning [ 35 , 3 , 6 ] . In industrial inspection, snake-like robots have been mounted on serial manipulators [ 4 ] , mobile platforms [ 36 ] , and even aerial vehicles [ 25 ] to extend reach and dexterity. In this paper, we consider the FTL motion planning problem for CRs whose base pose is fully actuated in SE(3), as arises when a CR is mounted on a serial manipulator. Given a spatial path specified by ordered waypoints, the objective is to generate a continuous motion such that (i) the robot tip tracks the path during insertion, and (ii) the inserted portion of the robot body follows the path with minimal deviation. While a fully actuated base offers greater flexibility and expanded motion capability, it also introduces computational challenges by expanding the planning space by six additional dimensions. We address this problem with a sampling-based framework that decouples global shape search from local interpolation. The key enabler is a closed-form geometric construction that uniquely determines the 6-DOF base pose for any selected shape, guaranteeing exact tip placement without iterative optimization. This decoupling allows shape search to be performed via global search over a precomputed library—compatible with any forward model—while interpolation between waypoints exploits radial symmetry to ensure smooth transitions with a small number of forward model evaluations. To summarize our contribution, we present a FTL motion planning framework for manipulator-mounted CRs with exact tip tracking by construction. The framework supports general forward models beyond PCC while enabling efficient online planning through user-adjustable clustering. We establish formal guarantees including resolution completeness for shape search and asymptotic convergence for tip tracking, and validate the approach in simulation and on hardware. The implementation is open-sourced to support reproducibility. This is the first FTL method for continuum robots with a fully-actuated SE(3) base and formal planning guarantees. II Problem Formulation Following the standard FTL problem formulation, the desired path is given as an ordered set of 3D waypoints \mathcal{W}=\{\mathbf{w}_{1},\mathbf{w}_{2},\ldots,\mathbf{w}_{n}\} , \mathbf{w}_{i}\in\mathbb{R}^{3} . Unlike methods that assume specific path representations (e.g., constant-curvature arcs), our formulation accepts arbitrary waypoint sequences, whether user-defined, discretized from continuous curves, or generated by higher-level planners. The shape of a CR in configuration \mathbf{q} is described by backbone points \mathbf{p}(s) for arc length s\in[0,S] , computed

Read the complete text