基于关节转角估计器的绳驱动手术微器械位置全闭环控制

doi:10.13973/j.cnki.robot.170301

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

全文: PDF (823 KB) HTML ( ) 输出: BibTeX \| EndNote (RIS)
引用本文:
王文杰, 于凌涛, 杨景, 闫昱晟. 基于关节转角估计器的绳驱动手术微器械位置全闭环控制[J]. 机器人, 2018, 40(2): 231-239.DOI: 10.13973/j.cnki.robot.170301. WANG Wenjie, YU Lingtao, YANG Jing, YAN Yusheng. Full Closed-loop Position Control of the Surgical Cable-driven Micromanipulator Based on Joint Angle Estimator. ROBOT, 2018, 40(2): 231-239. DOI: 10.13973/j.cnki.robot.170301.

摘要手术机器人微器械末端空间狭小，无法安装角度检测传感器，不能进行位置全闭环控制．针对这个问题，提出了一种基于关节转角估计器的闭环控制方法．首先设计了4自由度微器械驱动方案，搭建了手术机器人微器械单关节原理样机实验系统，并基于绳驱动系统的动力学分析设计了关节转角估计器．利用动力学参数辨识的方法给出了关节转角估计器的参数，并通过实验数据分析给出了转角估计器的简化和修正模型．实验结果说明关节转角估计器的输出精度可以达到0.38°．最后以转角估计器的输出值作为反馈信号对微器械关节转角进行了闭环控制实验．结果表明，当系统自由运动时微器械关节转角的最大跟随误差为0.734°；当微器械末端加载1.5N的外力时，关节转角估计器的精度是0.59°，最大跟随误差是1.112°．这些说明本文提出的关节转角闭环控制方法具有比较高的控制精度．

	服务

	把本文推荐给朋友
	加入我的书架
	加入引用管理器
	E-mail Alert
	RSS

关键词 ：关节转角估计器, 绳驱动, 微器械, 位置控制, 动力学

Abstract：As the micromanipulator of surgical robots works in a narrow space, it is difficult to install any angle sensor at the end, and therefore the closed-loop position control can't be achieved. For this problem, a closed-loop control method based on joint angle estimator is presented. Firstly, a 4-DOF (degree of freedom) driving scheme for micromanipulator is designed, an experiment system is established on the single-joint principle prototype of the surgical robot micromanipulator, and the joint angle estimator is designed based on the dynamics analysis of the cable-driven system. Then, the parameters of joint angle estimator are given through the method of dynamic parameter identification. What's more, the simplified and modified model of the angle estimator is achieved by experimental data analysis. The experiment results show that the output precision of the joint angle estimator can reach 0.38°. Finally, the closed-loop control experiment of the micromanipulator joint angle is carried out by taking the output of the angle estimator as the feedback signal. Results show that the maximum following error of the micromanipulator joint angle is about 0.734° when the system moves freely. The precision of the joint angle estimator is 0.59° and the maximum following error is about 1.112°, when an external force of 1.5N is exerted on the micromanipulator end. These results indicate that the proposed closed-loop joint angle control method has a relatively high control accuracy.

Key words： joint angle estimator cable-driven micromanipulator position control dynamics

收稿日期: 2017-05-11 录用日期: 2017-08-29

ZTFLH:

TP242

基金资助:国家自然科学基金（61203358）；黑龙江省自然科学基金（F2015034）；中央高校基本科研业务费专项资金（HEUCFM170703）

通讯作者: 于凌涛,yulingtao@163.com E-mail: yulingtao@163.com

作者简介: 王文杰(1988-),男,博士生.研究领域:腹腔手术机器人,并联机器人;
于凌涛(1977-),男,博士,副教授.研究领域:腹腔手术机器人,并联机器人.

链接本文:

https://robot.sia.cn/CN/10.13973/j.cnki.robot.170301 或 https://robot.sia.cn/CN/Y2018/V40/I2/231

[1] 杜志江,孙立宁,富历新.医疗机器人发展概况综述 [J].机器人,2003,25(2):182-187.Du Z J, Sun L N, Fu L X. An overview of medical robots[J]. Robot, 2003, 25(2): 182-187.
[2] Hayashibe M, Suzuki N, Hashizume M, et al. Robotic surgery setup simulation with the integration of inverse-kinematics computation and medical imaging[J]. Computer Methods and Programs in Biomedicine, 2006, 83(1): 63-72.
[3] Hayashibe M, Suzuki N, Hashizume M, et al. Preoperative planning system for surgical robotics setup with kinematics and haptics[J]. The International Journal of Medical Robotics and Computer Assisted Surgery, 2005, 1(2): 76-85.
[4] 唐奥林.面向主从式微创外科手术机器人的遥操作运动控制策略研究 [D].上海:上海交通大学,2014:20-27, 70-90.Tang A L. Research on the teleoperation motion control strategy for a master-slave minimally invasive surgical robot[D]. Shanghai: Shanghai Jiao Tong University, 2014: 20-27, 70-90.
[5] 马如奇.微创腹腔外科手术机器人执行系统研制及其控制算法研究[D].哈尔滨:哈尔滨工业大学,2013:65-67. Ma R Q. Development of the celiac minimally invasive surgery robotic executing system and research on its control algorithm [D]. Harbin: Harbin Institute of Technology, 2013: 65-67.
[6] 于凌涛,王文杰,王正雨,等.一类不满足 Pieper 准则的机器人逆运动学解析解获取方法 [J].机器人,2016,38(4):486-494.Yu L T, Wang W J, Wang Z Y, et al. Acquisition method of inverse kinematics analytical solutions for a class of robots dissatisfying the Pieper criterion[J]. Robot, 2016, 38(4): 486-494.
[7] Shimizu T, Sasaki M, Okada T. Tip position control of a two links flexible manipulator based on the dynamic extension technique[C]//Proceedings of SICE Annual Conference, vol.1-8. Piscataway, USA: IEEE, 2007: 868-873.
[8] 林明耀,刘文勇,周谷庆.无位置传感器无刷直流电机短时脉冲定位加速方法[J].电工技术学报,2011,26(9):80-86.Lin M Y, Liu W Y, Zhou G Q. A location and acceleration method of sensorless brushless DC motor utilizing short voltage pulse[J]. Transactions of China Electrotechnical Society, 2011, 26(9): 80-86.
[9] Wang H, Chen W, Yu X, et al. Visual servo control of cable-driven soft robotic manipulator[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2013: 57-62.
[10] Berkelman P, Cinquin P, Troccaz J, et al. A compact, compliant laparoscopic endoscope manipulator[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2002: 1870-1875.
[11] Kosari S N, Ramadurai S, Chizeck H J, et al. Control and tension estimation of a cable driven mechanism under different tensions [C]//ASME International Design Engineering Technical Conferences and Computers and Information in Engineering Conference. New York, USA: ASME, 2013: No. V06AT07A077.
[12] Haraguchi D, Kanno T, Tadano K, et al. A pneumatically driven surgical manipulator with a flexible distal joint capable of force sensing[J]. IEEE/ASME Transactions on Mechatronics, 2015, 20(6): 2950-2961.
[13] Lee H C Y J J, Chen M S. Control for tendon-driven manipulators with flexible tendons using artificial potential field approach [C/OL]//12th IFToMM World Congress. (2017-06-21) [2017-03-12]. http://citeseerx.ist.psu.edu/viewdoc/download; jsessionid=271C1AEED66C93AB082259F9B6A31CD0?doi =10.1.1.137.4841&rep=rep1&type=pdf.
[14] Lum M J H, Friedman D C W, Sankaranarayanan G, et al. The RAVEN: Design and validation of a telesurgery system[J]. International Journal of Robotics Research, 2009, 28(9): 1183-1197.
[15] Li H, Kawashima K, Tadano K, et al. Achieving haptic perception in forceps' manipulator using pneumatic artificial muscle[J]. IEEE/ASME Transactions on Mechatronics, 2013, 18(1): 74-85.
[16] Tadano K, Kawashima K. Development of 4-DOFs forceps with force sensing using pneumatic servo system[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2006: 2250-2255.
[17] Huard B, Grossard M, Moreau S, et al. LPV modeling and experimental identification of a new self-sensing finger joint[J]. IFAC Proceedings Volumes, 2011, 44(1): 999-1004.