Abstract:A gravity compensation algorithm for master manipulator used in minimally invasive robot surgery is proposed in this paper. The Lagrange dynamic equation is used to solve the motor output torque for balancing the master gravity. To avoid time delay in signal processing, multi-thread and multi-event technology are used in software control system. With the algorithm, the force by hand is very small under the condition of exist gravity compensation, less output more than 90% of the external force compared with the lack of gravity compensation.

Research Gravity Compensation for Master Manipulator with Time Delay