A resistance torque compensation algorithm based on Luenberger observer for minimally invasive surgical robot

The patient-side manipulator (PSM) achieves high torque capability by combining harmonic servo system with high reduction ratio and low torque motor. However, high reduction ratio can increase inertia and decrease compliance of the manipulator. To enhance the backdrivability of the minimally invasive surgical robot, this paper aims to propose a resistance torque compensation algorithm.

A resistance torque compensation algorithm based on dynamics and Luenberger observer is proposed. The dynamics are established, considering joint flexibility and an improved Stribeck friction model. The dynamic parameters are experimentally identified by using the least squares method. With the advantages of clear structure, simple implementation and fast solution speed, the Luenberger observer is selected to estimate the unmeasured dynamic information of PSM and realize the resistance torque compensation.

For low-speed surgical robots, the centrifugal force term in the dynamic model can be simplified to reduce computational complexity. Joint flexibility and an improved Stribeck friction model can be considered to improve the accuracy of the dynamic model. Experiment results show that parameter identification and estimated results of the Luenberger observer are accurate. The backdrivability of the PSM is enhanced in ease and smoothness.

This algorithm provides potential application prospects for surgical robots to maintain high torque while remaining compliant. Meanwhile, the enhanced backdrivability of the manipulator helps to improve the safety of the preoperative manual adjustment.