Force-Free Control for Direct Teaching of a Surgical Assistant Robot End Effector with Wire-Driven Bidirectional Telescopic Mechanism

摘要

This paper shows the design and modeling of an end effector with a bidirectional telescopic mechanism to allow a surgical assistant robot to hold and handle surgical instruments. It also presents a force-free control algorithm for the direct teaching of end effectors. The bidirectional telescopic mechanism can actively transmit force both upwards and downwards by staggering the wires on both sides. In order to estimate and control torque via motor current without a force/torque sensor, the gravity model and friction model of the device are derived through repeated experiments. The LuGre model is applied to the friction model, and the static and dynamic parameters are obtained using a curve fitting function and a genetic algorithm. Direct teaching control is designed using a force-free control algorithm that compensates for the estimated torque from the motor current for gravity and friction, and then converts it into a position control input. Direct teaching operation sensitivity is verified through hand-guiding experiments.