Design of the Control System and Home Point Positioning Device for Minimally Invasive Vascular Interventional Surgery Robot
DUAN Xingguang1,2, CHEN Yue1,2, YU Huatao1,2
1. Intelligent Robot Institute, Beijing Institute of Technology, Beijing 100081, China;
2. MOE Key Laboratory of Bionic Robot and System, Beijing 100081, China
段星光, 陈悦, 于华涛. 微创血管介入手术机器人控制系统与零位定位装置设计[J]. 机器人, 2012, 34(2): 129-136.DOI: 10.3724/SP.J.1218.2012.00129.
DUAN Xingguang, CHEN Yue, YU Huatao. Design of the Control System and Home Point Positioning Device for Minimally Invasive Vascular Interventional Surgery Robot. ROBOT, 2012, 34(2): 129-136. DOI: 10.3724/SP.J.1218.2012.00129.
To realize the accurate positioning and stable holding of surgical tools by minimally invasive vascular interventional surgery (VIS) robot, a control system and a home point positioning device are designed. Constitutions of the robot system and its upper-lower control system based on PMAC (programmable multi-axis controller) are introduced firstly. Meanwhile, the quintic interpolation motion planning and three-loop PID algorithms are designed, which improve both the robot’s response speed and stability. To find the base point of the robot’s motion, the home point positioning method and device are proposed based on Hall sensors and information of motor motion. The experiment results show that the presented home point positioning device works stably and accurately.
[1] Lu W S, Liu D, Tian Z, et al. The analysis of key technologies of intravascular intervention surgical robot [J]. Journal of Biomedical Engineering Research, 2009, 28(4): 303-306.
[2] Mack M J. Minimally invasive and robotic surgery [J]. JAMA-Journal of the American Medical Association, 2001, 285(5): 568-572.
[3] Tercero C, Ikeda S, Uchiyama T, et al. Autonomous catheter insertion system using magnetic motion capture sensor for endovascular surgery [J]. International Journal of Medical Robotics and Computer Assisted Surgery, 2007, 3(1): 52-58.
[4] Srimath-Veeravalli G, Kesavadas T, Li X Y. Design and fabrication of a robotic mechanism for remote steering and positioning of interventional devices [J]. International Journal of Medical Robotics and Computer Assisted Surgery, 2010, 6(2): 160-170.
[5] Beyar R, Gruberg L, Deleanu D, et al. Remote-control percutaneous coronary interventions-Concept, validation, and first-in-humans pilot clinical trial [J]. Journal of the American College of Cardiology, 2006, 47(2): 296-300.
[6] Faddis M N, Lindsay B D. Magnetic catheter manipulation [J]. Coronary Artery Disease, 2003, 14(1): 25-27.
[7] Zhao H H, Duan X G, Huang Q, et al. Design of an active locating manipulator for vascular interventional surgery [C]//World Congress on Intelligent Control and Automation. Piscataway, NJ, USA: IEEE, 2011: 605-609.
[8] Liu D, Zhang D P, Wang T M. Overview of the vascular interventional robot [J]. International Journal of Medical Robotics and Computer Assisted Surgery, 2008, 4(4): 289-294.
[9] 杨闯,王田苗,王满宜,等.基于嵌入式技术的数字化手术平台控制系统 [J].机器人,2008,30(2):176-181. Yang C, Wang T M, Wang M Y, et al. Control system of digital surgery platform based on embedded technology [J]. Robot, 2008, 30(2): 176-181.
[10] 韩京清.从PID技术到“自抗扰控制”技术 [J].控制工程,2002,9(3):13-18. Han J Q. From PID technique to active disturbances rejection control technique [J]. Control Engineering of China, 2002, 9(3): 13-18.
[11] Astrom K J, Hagglund T. PID controllers: Theory, design, and tuning [M]. Research Triangle Park, USA: ISA Press, 1995.
[12] Athalye A M, Grantham W J. Notch filter feedback control of a chaotic system [C]//Proceedings of the American Control Conference. Piscataway, NJ, USA: IEEE, 1995: 837-841.