面向高精度显微手术机器人的RCM机械臂误差补偿方法

doi:10.3901/JME.2022.18.170

机械工程学报 ›› 2022, Vol. 58 ›› Issue (18): 170-180.doi: 10.3901/JME.2022.18.170

扫码分享

面向高精度显微手术机器人的RCM机械臂误差补偿方法

白明^1,2, 张明路², 张赫¹, 庞淋峻¹, 赵杰¹

1. 哈尔滨工业大学机器人技术与系统国家重点实验室 150006;
2. 河北工业大学机械工程学院天津 300401

收稿日期:2022-03-28 修回日期:2022-07-25 出版日期:2022-09-20 发布日期:2022-12-08
通讯作者: 张赫(通信作者)，男，1982年出生，副教授，博士研究生导师。主要研究方向为医疗机器人技术、足式机器人技术、操作臂人机协作技术。E-mail：zhanghe0451@hit.edu.cn
作者简介:白明,男,1989年出生,博士研究生。主要研究方向为手术机器人技术,运动学标定,双臂协作技术;E-mail:bm673258549@163.com
基金资助:
国家自然科学基金(52175008, 920480301, U1913211, 52175008)、河北省自然科学基金(F2021202016)、省部共建电工装备可靠性与智能化国家重点实验室(河北工业大学)(EERI_0Y2021004)和机器人技术与系统国家重点实验室(哈尔滨工业大学) (SKLRS2022KF17)。

Error Compensation Method for High Precision Microsurgical Robot with RCM Manipulator

BAI Ming^1,2, ZHANG Minglu², ZHANG He¹, PANG Linjun¹, ZHAO Jie¹

1. Harbin Institute of Technology, State Key Laboratory of Robotics and System, Harbin 150006;
2. School of Mechanical Engineering, Hebei University of Technology, Tianjin 300401

Received:2022-03-28 Revised:2022-07-25 Online:2022-09-20 Published:2022-12-08

摘要/Abstract

摘要： 为了实现机器人辅助微创手术，带有远程运动中心(Remote central motion, RCM)机构的机械臂被广泛应用于手术机器人系统。操作尤为精细的显微手术对机器人的精准度和安全性提出更高要求。针对眼底显微手术机器人的构型特点，在运动学标定基础上提出一种减小定位误差、RCM约束点偏差和逆运动学求解时间的补偿方法。建立机器人误差模型并辨识几何参数；基于功能和机构特点，建立RCM约束点和末端点的运动学方程和误差补偿模型，采用冗余自由度实时补偿RCM约束点偏差，并以解析解实现RCM约束点偏差和末端位置误差同时补偿的高效逆运动学求解方法；在所搭建的手术机器人平台上进行试验，结果表明，所提出的方法将末端定位误差减小到0.142 6 mm，与迭代法相比RCM约束点偏差减小92.72%，且计算效率提升89.97%，验证了该方法的有效性，对提升显微手术机器人的精准性和安全性具有重要意义。

关键词: RCM机械臂, 显微手术机器人, 运动学标定, 误差补偿, 逆运动学

Abstract: To achieve robot-assisted minimally invasive surgery, manipulator with remote center motion (RCM) mechanism is widely used in surgical robot system. Especially, microsurgery with particularly precise operation requires higher precision and safety of the robot. Aiming at the characteristics of fundus microsurgery robot, based on kinematic calibration, an error compensation method is proposed to reduce positioning error, RCM bias and inverse kinematics solution time. The error model of the robot is established and the geometric parameters are identified; Based on the function and characteristics of the mechanism, the kinematic equations and error compensation model between RCM and end-effector points are established, redundant degrees of freedom are used to compensate the RCM bias in real time. An efficient inverse kinematics method for simultaneous compensation of RCM bias and end-effector position error is realized by analytical solution. Experiments are carried out on the developed surgical robot platform, the results show that the end-effector positioning error reduce to 0.1426 mm. Compared with the iterative method, the RCM bias is reduced by 92.72% and calculation efficiency increased by 89.97%. The effectiveness of the proposed method is verified, which is of great significance to improve the operation precision and safety of the microsurgery robot.

Key words: RCM manipulator, microsurgery robot, kinematic calibration, error compensation, inverse kinematics

中图分类号:

TG156

白明, 张明路, 张赫, 庞淋峻, 赵杰. 面向高精度显微手术机器人的RCM机械臂误差补偿方法[J]. 机械工程学报, 2022, 58(18): 170-180.

BAI Ming, ZHANG Minglu, ZHANG He, PANG Linjun, ZHAO Jie. Error Compensation Method for High Precision Microsurgical Robot with RCM Manipulator[J]. Journal of Mechanical Engineering, 2022, 58(18): 170-180.

参考文献

[1] FUNDA J，TAYLOR R H，ELDRIDGE B，et al. Constrained cartesian motion control for teleoperated surgical robots[J]. IEEE Transactions on Robotics and Automation，1996，12(3):453-465.
[2] TAYLOR R H，Stoianovici D. Medical robotics in computer-integrated surgery[J]. IEEE Transactions on Robotics and Automation，2003，19(5):765-765.
[3] Kuo C H，DAI J S，Dasgupta P. Kinematic design considerations for minimally invasive surgical robots:An overview[J]. The International Journal of Medical Robotics and Computer Assisted Surgery，2012，8(2):127-145.
[4] Eldridge B，Gruben K，LaRose D，et al. A remote center of motion robotic arm for computer assisted surgery[J]. Robotica，1996，14(1):103-109.
[5] Alamdar A，Samandi P，Hanifeh S，et al. Investigation of a hybrid kinematic calibration method for the “sina” surgical robot[J]. IEEE Robotics and Automation Letters，2020，5(4):5276-5282.
[6] Taylor R，Jensen P，Whitcomb L，et al. A steady-hand robotic system for microsurgical augmentation[J]. The International Journal of Robotics Research，1999，18(12):1201-1210.
[7] Jung M，Morel P，Buehler L，et al. Robotic general surgery:current practice，evidence，and perspective[J]. Langenbeck's Archives of Surgery，2015，400(3):283-292.
[8] MITCHELL B，KOO J，IORDACHITA M，et al. Development and application of a new steady-hand manipulator for retinal surgery[C]// 2007 IEEE International Conference on Robotics and Automation (ICRA)，10-14 April 2007，Roma，Italy，IEEE:NewYork，2007:623-629.
[9] Bergeles C，Yang G Z. From passive tool holders to microsurgeons:safer，smaller，smarter surgical robots[J]. IEEE Transactions on Biomedical Engineering，2013，61(5):1565-1576.
[10] Yang G Z，Cambias J，Cleary K，et al. Medical robotics—regulatory，ethical，and legal considerations for increasing levels of autonomy[J]. Science Robotics，2017，2(4):8638.
[11] Suzuki H，Wood R J. Origami-inspired miniature manipulator for teleoperated microsurgery[J]. Nature Machine Intelligence，2020，2(8):437-446.
[12] Rosa B，Gruijthuijsen C，Van Cleynenbreugel B，et al. Estimation of optimal pivot point for remote center of motion alignment in surgery[J]. International Journal of Computer Assisted Radiology and Surgery，2015，10(2):205-215.
[13] Klodmann J，Schlenk C，Hellings-Kuß A，et al. An introduction to robotically assisted surgical systems:current developments and focus areas of research[J]. Current Robotics Reports，2021，2(3):321-332.
[14] Zaplana I，Basanez L. A novel closed-form solution for the inverse kinematics of redundant manipulators through workspace analysis[J]. Mechanism and Machine Theory，2018，121(3):829-843.
[15] Menaker A，Shah S，Snelling B M，et al. Current applications and future perspectives of robotics in cerebro -vascular and endovascular neurosurgery[J]. Journal of Neurointerventional Surgery，2018，10(1):78-82.
[16] Kim C K，Chung D G，Hwang M，et al. Three-degrees-of-freedom passive gravity compensation mechanism applicable to robotic arm with remote center of motion for minimally invasive surgery[J]. IEEE Robotics and Automation Letters，2019，4(4):3473-3480.
[17] Aksungur S. Remote center of motion (RCM) mechanisms for surgical operations[J]. International Journal of Applied Mathematics Electronics and Computers，2015，3(2):119-126.
[18] Edwards T L，Xue K，Meenink H C M，et al. First-in-human study of the safety and viability of intraocular robotic surgery[J]. Nature Biomedical Engineering，2018，2(9):649-656.
[19] Taylor R H，Funda J，Eldridge B，et al. A telerobotic assistant for laparoscopic surgery[J]. IEEE Engineering in Medicine and Biology Magazine，1995，14(3):279-288.
[20] Smits J，Reynaerts D，Vander Poorten E. Synthesis and methodology for optimal design of a parallel remote center of motion mechanism:Application to robotic eye surgery[J]. Mechanism and Machine Theory，2020，151(0094-114X):103896.
[21] Chen G，Wang J，Wang H，et al. Design and validation of a spatial two-limb 3R1T parallel manipulator with remote center-of-motion[J]. Mechanism and Machine Theory，2020，149:103807.
[22] Chen G，Wang J，Wang H. A new type of planar two degree-of-freedom remote center-of-motion mechanism inspired by the peaucellier lipkin straight-line linkage[J]. Journal of Mechanical Design，2019，141(1):015001- 015009.
[23] Vander Poorten E，Riviere C N，Abbott J J，et al. Robotic retinal surgery[M]. New York:Elsevier，2020.
[24] Bai M，Zhang M，Zhang H，et al. An error compensation method for surgical robot based on RCM Mechanism[J]. IEEE Access，2021，9(2):140747 -140758.
[25] Wampler C W. Manipulator inverse kinematic solutions based on vector formulations and damped least-squares methods[J]. IEEE Transactions on Systems，Man，and Cybernetics，1986，16(1):93-101.
[26] CRAIG J J. Introduction to robotics:Mechanics and control[J]. Automatica，1987，23(2):263-264.
[27] Fratu A，Vermeiren L，Dequidt A. Using the redundant inverse kinematics system for collision avoidance[C]// 2010 Proceedings of International Symposium on Electrical and Electronics Engineering，September 16-18，2010，Galati，Romania. IEEE:NewYork，2010:88-93.
[28] Kim J S，Jeong J H，Park J H. Inverse kinematics and geometric singularity analysis of a 3-SPS/S redundant motion mechanism using conformal geometric algebra[J]. Mechanism and Machine Theory，2015，90:23-36.
[29] Drexler D A. Solution of the closed-loop inverse kinematics algorithm using the Crank-Nicolson method[C]// Proceedings of International Symposium on Applied Machine Intelligence and Informatics. Slovakia:IEEE，2016:351-356.
[30] Zhao J，Gong S，Zhang Z. Analytical inverse kinematics of anthropomorphic movements for 7-DOF humanoid manipulators[J]. Journal of Mechanical Engineering，2018，54(21):25-32.
[31] PIPER D. The kinematics of manipulators under computer control [M]. Stanford:PHD Thesis Stanford University，1968.
[32] Paul R P. Robot manipulators:Mathematics，programming，and control:the computer control of robot manipulators[M]. Cambridge:The MIT Press，1981.

面向高精度显微手术机器人的RCM机械臂误差补偿方法

Error Compensation Method for High Precision Microsurgical Robot with RCM Manipulator

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	杨晓航, 赵智远, 李云涛, 徐梓淳, 赵京东. 基于可操作度优化的冗余机械臂逆运动学求解方法[J]. 机械工程学报, 2024, 60(7): 22-33.
[2]	石建平, 徐永驰, 古训, 陈冬云. 面向冗余机械臂逆运动学问题的人工蜂群算法改进[J]. 机械工程学报, 2024, 60(15): 60-70.
[3]	张德权, 李星奥, 张宁, 宁国松, 韩旭. 工业机器人全域误差场精细化建模方法及其误差补偿策略[J]. 机械工程学报, 2024, 60(13): 316-329.
[4]	周健, 郑联语, 樊伟, 张学鑫, 曹彦生. 工业机器人定位误差在线自适应补偿[J]. 机械工程学报, 2023, 59(5): 53-66.
[5]	赵京, 周振勇, 张自强. 冗余度机械臂的自运动流形计算及关节轨迹规划[J]. 机械工程学报, 2023, 59(5): 77-88.
[6]	张冰鑫, 刘侃, 李跃, 胡伟, 黄庆, 陈泳丹. 基于累积误差补偿的永磁同步电机低速插值控制策略^*[J]. 电气工程学报, 2023, 18(3): 145-153.
[7]	张英, 冯征征, 李剑, 魏世民, 廖启征. 基于CGA的7自由度冗余机械臂逆运动学臂型角参数化方法[J]. 机械工程学报, 2023, 59(23): 68-75.
[8]	钟献有, 王鹤霖, 刘成菊, 陈启军. 基于最小运动变换的臂角参数化冗余机械臂逆运动学求解方法[J]. 机械工程学报, 2023, 59(15): 40-49.
[9]	陈菲菲, 居鹤华, 刘潇晗. 一种高精度求解多轴机器人逆运动学的方法[J]. 机械工程学报, 2023, 59(1): 50-58.
[10]	张俊, 鲍雨菲, 方汉良, 宋亚庆. 新型5轴混联加工单元的后置处理算法[J]. 机械工程学报, 2023, 59(1): 298-308.
[11]	陈菲菲, 居鹤华, 余萌, 康杰, 孙帅. 一种分析四元数及其在6R机械臂逆运动学中的应用[J]. 机械工程学报, 2022, 58(9): 31-40.
[12]	赵智远, 赵京东, 赵亮亮, 杨晓航, 刘宏. 求解SSRMS构型空间机械臂逆运动学的方法[J]. 机械工程学报, 2022, 58(3): 21-35.
[13]	杨勇明, 汪中厚, 刘雷, 石照耀, 久保爱三. 磨齿机在机检测系统的测头综合预行程误差建模[J]. 机械工程学报, 2022, 58(21): 250-265.
[14]	张英, 黄起能, 廖启征, 杨旭, 魏世民. 空间6R串联机械手逆运动学分析的新方法研究[J]. 机械工程学报, 2022, 58(19): 1-11.
[15]	罗任峰, 王旭浩, 张大卫, 张培伦, 赵臣. 一种6R非球型手腕机器人逆运动学算法研究[J]. 机械工程学报, 2022, 58(19): 68-76.