A Discrete-Jointed Robot Model Based Control Strategy for Spatial Continuum Manipulators

Abstract

In this paper, a novel strategy is designed for trajectory control of a multi-section continuum robot in three-dimensional space to achieve accurate orientation, curvature, and section length tracking. The formulation connects the continuum manipulator dynamic behavior to a virtual discrete-jointed robot whose degrees of freedom are directly mapped to those of a continuum robot section. Based on this connection, a computed torque control architecture is developed for the virtual robot, for which inverse kinematics and dynamic equations are constructed and exploited, with appropriate transformations developed for implementation on the continuum robot. The control algorithm is implemented on a six degree-of-freedom two-section OctArm continuum manipulator. Experimental results show that the proposed method managed simultaneous extension/contraction, bending, and torsion actions on multi-section continuum robots with decent tracking performance (steady state arc length and curvature tracking error of merely 3.3mm and 0.13m <sup xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink">-1</sup> , respectively). These results demonstrate that the proposed method can be applied to multi-section continuum manipulators and perform complex maneuvers within a nonlinear setting.