6-D Tip Wrench Estimation for Continuum Robots: A Koopman-UKF-Wrench Decomposition Approach
- 26 May 2026
- journal article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Robotics
- Vol. 42 (15523098) , 2439-2458
Abstract
This paper presents a method for comprehensive 6D estimation of tip wrench for generally deflected static elastic rods. Current methods for load estimation are restricted to estimating lateral (point or distributed) forces for (quasi-)planar deformation; estimation of tangential force and moment, i.e., the full 6D wrench, remains largely unreliable due to the ill-posed nature of the problem. To address this challenge, this paper begins by proposing a high-fidelity static rod model that leverages Koopman Operator theory. Building on this model and utilizing shape feedback, a computationally efficient three-step wrench estimator is proposed: (i) a Koopman-UKF local moment observer, (ii) a static equilibrium solver, and (iii) a rod model propagator. Then, a 2D wrench screw system, identified as the insensible wrench in the initial estimation, elucidates error sources and informs strategies to enhance accuracy by incorporating additional feedback, such as the rod tip material frame and base axial force. Ultimately, the framework delivers accurate 6D tip wrench estimation with quantified uncertainty. Simulation and experimental evaluations validate its effectiveness, demonstrating mean errors of $53.14\,$mN (1.94%) and $2.65\,$mNm (7.18%) for a $159\,$mm-long Nitinol tube undergoing complex out-of-plane deformations, outperforming three replicated state-of-the-art methods. Additionally, its applicability to more complex continuum robots is demonstrated through load estimation on a Parallel Continuum Robot.Keywords
Funding Information
- China Scholarship Council (202006230075)
- National Institute for Health and Care Research (NIHR202879)
- Wellcome EPSRC Centre for Medical Engineering (WT 203148/Z/16/Z)
This publication has 47 references indexed in Scilit:
- Real-time dynamics of soft manipulators with cross-sectional inflation: application to the octopus muscular hydrostatProceedings of the Royal Society A: Mathematical, Physical and Engineering Sciences, 2025
- Shape reconstruction of soft continuum robots via the fusion of local strains and global posesCell Reports Physical Science, 2024
- SE(3) Koopman-MPC: Data-driven Learning and Control of Quadrotor UAVsIFAC-PapersOnLine, 2023
- Curvature-based force estimation for an elastic tubeRobotica, 2023
- Stochastic model-based contact force estimation for concentric tube robotsMechanism and Machine Theory, 2022
- Data-Driven Models for Control Engineering Applications Using the Koopman Operator2022
- A learning-based tip contact force estimation method for tendon-driven continuum manipulatorScientific Reports, 2021
- Three dimensional force estimation for steerable catheters through bi-point trackingSensors and Actuators A: Physical, 2018
- Linear predictors for nonlinear dynamical systems: Koopman operator meets model predictive controlAutomatica, 2018
- State Estimation for Robotics2017