Riemannian Optimization-based Whole-body Obstacle Avoidance for Mobile Continuum Robots in Cluttered Environments
Organizations: Department of Mechanical Engineering, University of Hong Kong, Hong Kong, China · Department of Aeronautics, Imperial College London, UK · Department of Electronic and Computer Engineering, Hong Kong University of Science and Technology, Hong Kong, China · Nagoya University, Meijo University, Japan and Beijing Institute of Technology, China ·
Abstract
Inspired by the coordination of global motion and local shape adaptation in snakes, elephant trunks, and octopus arms, we propose a unified planning and control framework for mobile continuum robots in cluttered and confined environments. Existing approaches often address high-level path planning and local motion control separately, limiting coordinated base-arm motion, kinematic consistency, and collision avoidance. Our framework integrates long-horizon trajectory planning with real-time geometric refinement under kinematic and environmental constraints. The global layer combines A* search with minimum-jerk planning to generate smooth reference trajectories. The local layer uses a geometry-consistent inverse kinematics solver and Riemannian optimization to coordinate mobile-base motion and continuum deformation while avoiding obstacles. We evaluate the framework through simulated pipe-traversal tasks with multiple baseline planners and real-world experiments involving navigation among dense obstacles and manipulation in confined spaces. Results demonstrate improved motion consistency, feasibility, and adaptability, supporting coordinated whole-body motion of mobile continuum robots in constrained environments.
Figures & tables
| Method | Avg Time (ms) | Max Time (ms) | Avg Iter | Max Iter | Success Rate (%) |
|---|---|---|---|---|---|
| Ours | 2.20 | 21.84 | 4.16 | 8 | 100 |
| FABRIKc [ 35 ] | 22.2 | 82.6 | 44.55 | 112 | – |
| FABRIKx [ 37 ] | 3.3 | – | 17 | – | 93.8 |
| Jacobian [ 35 ] | 192.6 | 217.7 | 1604.8 | 1722 | – |
| Method | Optimization Strategy | Search Space | Avg Time (ms) | Avg Iterations | Success Rate (%) |
|---|---|---|---|---|---|
| RMO (Ours) | Geometric Heuristic (with Riemannian Manifold Opt.) | Ori | 6 | 15 | 100 |
| IS (without RMO) | Geometric Heuristic (without Manifold Geometry) | Ori | 14 | 32 | 98 |
| Grad-Ori | Euclidean gradient optimization | Ori | 43 | 64 | 80 |
| Grad-Angles | Euclidean gradient optimization | Config | 253 | 79 | 62 |
| Grid-Search | Exhaustive discrete search | Ori | 132 | 75 | 55 |
Continuum Robot Control
Continuum robot control studies how to model, sense, and guide flexible robots whose bodies bend and deform along their length.
See all 76 papers