Data-based Shape Self-sensing of a Cable-Driven Notched Continuum Mechanism Using Multi-dimensional Intrinsic Force Information for Surgical Robot

The accurate shape sensing capability of the continuum mechanism is fundamental to improve and guarantee the motion control accuracy and safety of continuum surgical robots. This paper presents a data-based shape self-sensing method for a cable-driven notched continuum mechanism using its multi-dimensional intrinsic force information, which mainly includes the multi-dimensional forces/torques and driving cable tensions, et al. The nonlinear hysteresis compensation and the shape estimation of the notched continuum mechanism play significant roles in its motion control. Calibration compensation of the notched continuum mechanism is performed based on kinematic modeling to improve the accuracy of its preliminary motion control. The hysteresis characteristics of the continuum mechanism is analyzed, modeled and compensated through considering the abundant dynamic motion experiments, such that a feedforward hysteresis compensation controller is designed to improve the tracking control performance of continuum mechanism. Based on the kinematics calibration and hysteresis compensation, combined with the motor displacement, driving cable tensions and six-dimensional forces/torques information of the continuum mechanism, a data-based shape self-sensing method based on Particle Swarm Optimization BP Neural Network (PSO-BPNN) is proposed in this study. Experimental results show that this method can effectively estimate the loaded and unloaded shape of the notched continuum mechanism, which provides a new approach for the shape reconstruction of cable-driven notched continuum surgical robots.