王文杰, 于凌涛, 杨景, 闫昱晟. 基于关节转角估计器的绳驱动手术微器械位置全闭环控制[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.
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.
[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.