Improving backdrivability in preoperative manual manipulability of minimally invasive surgery robot

The purpose of this paper is to propose a control algorithm to improve the backdrivability performance of minimally invasive surgical robotic arms, so that precise manual manipulations of robotic arms can be performed in the preoperative operation.

First, the flexible-joint dynamic model of the 3-degree of freedom remote center motion (RCM) mechanisms of minimally invasive surgery (MIS) robot is derived and its dynamic parameters and friction parameters are identified. Next, the angular velocities and angular accelerations of joints are estimated in real time by the designed Kalman filter. Finally, a control algorithm based on Kalman filter is proposed to enhance the backdrivability of RCM mechanisms by compensating for the internally generated gravitational, frictional and inertial resistances experienced during the positioning and orientating.

The parameter identification for RCM mechanisms can be experimentally evaluated from comparison between the measured torques and the reconstructed torques. The accuracy and convergence of the real-time estimation of angular velocity and acceleration of the joint by the designed Kalman filter can be verified from corresponding simulation experiments. Manual adjustment experiments and animal experiments validate the effectiveness of the proposed backdrivability control algorithm.

The backdrivability control algorithm presented in this paper is a universal method to enhance the manual operation performance of robots, which can be used not only in the medical robot preoperative manual manipulation but also in robot haptic interaction, industrial robot direct teaching and active rehabilitation training of rehabilitation robot and so on.

Compared with other backdrivability design methods, the proposed algorithm achieves good backdrivability for RCM mechanisms without using force sensors and accelerometers. In addition, this paper presents a new static friction compensation approach for a joint moving with very low velocity.