微创手术机器人力反馈主手重力补偿研究

doi:10.13973/j.cnki.robot.190547

摘要
图/表
参考文献
相关文章 (8)

全文: PDF (35730 KB) HTML ( ) 输出: BibTeX \| EndNote (RIS)
引用本文:
王涛, 潘博, 付宜利, 王树国. 微创手术机器人力反馈主手重力补偿研究[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.

摘要针对医生操作微创手术机器人力反馈主手进行主从微创手术时力反馈主手各杆件重力阻碍操作性能的问题，基于虚位移原理对力反馈主手各关节的重力矩进行推导，并采用Adams仿真软件对其进行验证．该方法适用于开链和闭链结构的机器人臂，与传统的牛顿－欧拉法和拉格朗日法相比，它不需考虑速度、加速度，且简单有效．然后采用电机驱动的方式对力反馈主手的各连杆重力进行补偿，实现了重力的完全补偿．实验结果表明，基于虚位移原理的主动重力补偿能够达到较好的补偿效果，将未补偿前的重力矩作用减小了60%以上，提高了力反馈主手的操作性能．

	服务

	把本文推荐给朋友
	加入我的书架
	加入引用管理器
	E-mail Alert
	RSS
	作者相关文章
	王涛
	潘博
	付宜利
	王树国

关键词 ：力反馈主手, 重力补偿, 虚位移原理, Adams仿真, 主动补偿

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.

Key words： force reflection manipulator gravity compensation virtual displacement principle Adams simulation active compensation

收稿日期: 2019-10-14 录用日期: 2020-03-16

TP242.2

基金资助:国家自然科学基金（61305139）；国家863计划（2012AA041601）．

通讯作者: 潘博,panbo4034@163.com E-mail: panbo4034@163.com

作者简介: 王涛(1987-),男,博士生.研究领域:医疗机器人技术,力反馈主手.
潘博(1981-),男,博士,副研究员.研究领域:机器人机构学,外科手术机器人.
付宜利(1966-),男,博士,教授.研究领域:医疗机器人,仿生机器人,生物机械工程.

链接本文:

https://robot.sia.cn/CN/10.13973/j.cnki.robot.190547 或 https://robot.sia.cn/CN/Y2020/V42/I5/525

[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.