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.
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: