王涛, 潘博, 付宜利, 王树国. 微创手术机器人力反馈主手重力补偿研究[J]. 机器人, 2020, 42(5): 525-533.DOI: 10.13973/j.cnki.robot.190547.
WANG Tao, PAN Bo, FU Yili, WANG Shuguo. Gravity Compensation for the Force Reflection Manipulator of Minimally Invasive Surgical Robot. ROBOT, 2020, 42(5): 525-533. DOI: 10.13973/j.cnki.robot.190547.
Abstract:When the surgeon performs the master-slave minimally invasive surgery by controlling the force reflection manipulator of the minimally invasive surgical robot, the gravities of its links will impede the manipulation performance. To solve this problem, the gravity torques on the joints of the force reflection manipulator are derived based on the virtual displacement principle, and the correctness of the formulation is verified through Adams simulation. The proposed method is applicable to the robot manipulators with the open-loop and closed-loop structures, and is simpler and more effective than the traditional Newton-Euler method and Lagrange method because it needn't consider the speed and acceleration. Then the link gravities of the force reflection manipulator are compensated fully through motor driving. Experimental results show that the active gravity compensation algorithm based on virtual displacement principle can achieve good performance by reducing the gravity torque effects by 60%, and improve the manipulation performance of the force reflection manipulator.
[1] 付宜利,潘博.微创外科手术机器人技术研究进展[J].哈尔滨工业大学学报,2019,51(1):7-21.Fu Y L, Pan B. Research progress of surgical robot for minimally invasive surgery[J]. Journal of Harbin Institute of Technology, 2019, 51(1):7-21. [2] Steger R, Lin K, Adelstein B D, et al. Design of a passively balanced spatial linkage haptic interface[J]. Journal of Mechanical Design, 2004, 126(6):984-991. [3] Rahman T, Ramanathan R, Seliktar R, et al. A simple technique to passively gravity-balance articulated mechanisms[J]. Journal of Mechanical Design, 1995, 117(4):655-658. [4] 李思桥,张玉茹,曹永刚,等.力觉交互设备的重力补偿实验研究[J].机械设计与研究,2007,23(1):95-97,105.Li S Q, Zhang Y R, Cao Y G, et al. Experiment research of gravity compensation for haptic device[J]. Machine Design and Research, 2007, 23(1):95-97,105. [5] 张玉茹,李朝斌,王党校,等.面向任务的力觉交互设备设计[J].机械工程学报,2015,51(13):212-217,226.Zhang Y R, Li C B, Wang D X, et al. Task oriented method for designing haptic devices[J]. Journal of Mechanical Engineering, 2015, 51(13):213-217,226. [6] Hayward V, Gregorio P, Astley O, et al. Freedom-7:A high fidelity seven axis haptic device with application to surgical training[M]//Lecture Notes in Control and Information Science, Vol.232. London, UK:Springer, 1998:445-456. [7] Arata J, Kondo H, Sakaguchi M, et al. Development of a haptic device "DELTA-4" using parallel link mechanism[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2009:1404-1410. [8] 薛雯,赵臣,维加.一种6自由度力反馈主手重力平衡方法[J].机械设计,2017,34(11):7-15.Xue W, Zhao C, Vichea D. A method to balance 6-DOF haptic master manipulator[J]. Journal of Machine Design, 2017, 34(11):7-15. [9] Mashayekhi A, Nahvi A, Yazdani M, et al. VirSense:A novel haptic device with fixed-base motors and a gravity compensation system[J]. Industrial Robot, 2014, 41(1):37-49. [10] Fan R F, Zhao C, Zhao H W. Improvement of dynamic transparency of haptic devices by using spring balance[C]//IEEE International Conference on Robotics and Biomimetics. Piscataway, USA:IEEE, 2012:1075-1080. [11] 赵汉望,范荣芳,赵臣.力反馈主手重力平衡方式改进[J].机械设计,2014,31(7):54-58.Zhao H W, Fan R F, Zhao C. Improvement of gravity balance system for a haptic device[J]. Journal of Machine Design, 2014, 31(7):54-58. [12] 李春泉.一种通用力反馈设备设计及其重力补偿研究[D].南昌:南昌大学,2014.Li C Q. Design of the general purpose haptic device and research on its gravity compensation[D]. Nanchang:Nanchang University, 2014. [13] 郭盛,梁艺瀚,王志群,等.基于虚拟仿真的并联构型手控器动力学建模与力反馈控制[J].机器人,2015,37(2):224-230.Guo S, Liang Y H, Wang Z Q, et al. Dynamic modeling and force-feedback control of haptic device with parallel structure based on virtual simulation[J]. Robot, 2015, 37(2):224-230. [14] 贠今天,刘阳阳,杨全利,等.力反馈主操作手附加力的补偿策略研究[J].中国机械工程,2017,28(10):1156-1162.Yun J T, Liu Y Y, Yang Q L, et al. Research on compensation strategy for induced forces of force feedback master manipulators[J]. China Mechanical Engineering, 2017, 28(10):1156-1162. [15] 刘世平,余昆,李世其,等.三自由度平动手控器重力补偿研究[J].机械制造与自动化,2015,44(2):155-158, 171.Liu S P, Yu K, Li S Q, et al. Research on gravity compensation of 3-DOF translation hand controller[J]. Machine Building & Automation, 2015, 44(2):155-158,171. [16] 崔建伟,宋爱国,黄惟一,等.一种新型六自由度通用型手控器[J].中国机械工程,2005,16(4):320-323.Cui J W, Song A G, Huang W Y, et al. A new 6-DOF universal hand controller[J]. China Mechanical Engineering, 2005, 16(4):320-323. [17] 王宏民,杜志江,闫志远,等.混联式主操作手重力补偿算法[J].机器人,2014,36(1):111-116,128.Wang H M, Du Z J, Yan Z Y, et al. Gravity compensation algorithm for hybrid master manipulator[J]. Robot, 2014, 36(1):111-116,128. [18] Qin H H, Song A G, Liu Y Q, et al. Design and calibration of a new 6DOF haptic device[J]. Sensors, 2015, 15(12):31293-31313.