Gravity Compensation Algorithm for Hybrid Master Manipulator
WANG Hongmin1,2, DU Zhijiang1, YAN Zhiyuan1, LIU Rongqiang1
1. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150080, China;
2. Electrization and Control Engineering School, Heilongjiang University of Science and Technology, Harbin 150027, China
A gravity compensation algorithm for master manipulator used in laparoscopic minimally invasive surgery robot is proposed. A hybrid serial-parallel configuration is adopted in the master manipulator, position and orientation are controlled separately, and each joint of the manipulator is equipped with motor. The Lagrange dynamic equation is used to obtain motor output torque for balancing the master manipulator gravity. To avoid time delay in signal processing, a speed observer is chosen to estimate velocity information, and the acceleration signals are obtained directly by introducing first order low-pass filter. Finally, under the conditions of opening and closing the gravity compensation algorithm, the master manipulator output force is measured by force sensor when master manipulator moves with human hand in free space. Comparing with the experimental data obtained without gravity compensation, the output force of the hand is reduced more than 90% with gravity compensation.
[1] Russo A, Sinatra R, Xi F. Static balancing of parallel robots[J]. Mechanism and Machine Theory, 2005, 40(2): 191-202. [2] 李思桥, 张玉茹, 曹永刚, 等.力觉交互设备的重力补偿实验研究[J].机械设计与研究, 2007, 23(1):95-97, 105.Li S Q, Zhang Y Y, Cao Y G, et al. Experiment research of gravity compensation for haptic device[J]. Machine Design and Research, 2007, 23(1): 95-97, 105.[3] Cho C H, Lee W S, Kang S C. Static balancing of a manipulator with hemispherical workspace[C]//Proceedings of International Conference on Advanced Intelligent Mechatronics. Piscataway, USA: IEEE, 2010: 1269-1274.[4] 方红根.基于力反馈数据手套的多指灵巧手主从控制的研究[D].哈尔滨:哈尔滨工业大学, 2010:49-51. Fang H G. Research on master-slave control based on force feedback glove and HIT/DLR hand[D]. Harbin: Harbin University of Technology, 2010: 49-51.[5] Yamamoto T. Applying tissue models in teleoperated robot-assisted surgery[D]. Baltimore, USA: Johns Hopkins University, 2011.[6] Tsumaki Y, Naruse H, Nenchev D N, et al. Design of a compact 6-DOF haptic interface[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 1998: 2580-2585.[7] Kang M J, Park J H, Kim J H, et al. A disturbance observer design for backlash compensation[J]. International Journal of Control, Automation, and Systems, 2011, 9(4): 742-749. [8] Ryua D, Songb J B, Choc C, Kangd S, et al. Development of a six DOF haptic master for teleoperation of a mobile manipulator[J]. Mechatronics, 2010, 20(2): 181-191. [9] Chaker A, Laribi M A, Zeghloul S, et al. Design and optimization of spherical parallel manipulator as a haptic medical device[C]//37th Annual Conference of IEEE Industrial Electronics Society. Piscataway, USA: IEEE, 2011: 80-85.