Master-Slave Control of the Celiac Minimally Invasive Surgical Robot
NIU Guojun1,2, QU Cuicui3, PAN Bo2, FU Yili2
1. School of Mechanical Engineering and Automation, Zhejiang Sci-Tech University, Hangzhou 310018, China;
2. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150001, China;
3. Hangzhou SIASUN Robot & Automation CO. LTD., Hangzhou 310000, China
Abstract：A master-slave control algorithm is proposed to improve the hand-eye coordination for an endoscopic celiac minimally invasive surgical robotic system based on the endoscopes. Forward and inverse kinematic models of the slave hand system are established based on the screw theory. Then a master-slave motion control algorithm is proposed based on the kinematic models in the endoscope coordinates, which consists of the motion consistency control, the relative motion control and the proportional motion control. Because the wrist of the master hand is passive (not driven by motor), it can't remain stationary at any position, and therefore the postures of the master and slave manipulators can't keep the same at the beginning of the operation, at the interruption in the middle of the operation, or at the adjustment of the workspace of the master. For this reason, three auxiliary functions are implemented, which are the master-slave posture registration function, the replacement function of surgical instrument and the master-salve remapping function. Last but not least, the collaring and the threading experiments are carried out. The maximum space position errors of these two groups of experiments are less than 1 mm, which shows the algorithm can effectively improve the consistency of hand-eye coordination.
[1] Dogangil G, Davies B L, Rodriguez y Baena F. A review of medical robotics for minimally invasive soft tissue surgery[J]. Proceedings of the Institution of Mechanical Engineers, Part H:Journal of Engineering in Medicine, 2010, 224(5):653-679.
[2] Herman B, Dehez B, Duy K T, et al. Design and preliminary in vivo validation of a robotic laparoscope holder for minimally invasive surgery[J]. International Journal of Medical Robotics and Computer Assisted Surgery, 2009, 5(3):319-326.
[3] Franzino R J. The Laprotek surgical system and the next generation of robotics[J]. Surgical Clinics of North America, 2003, 83(6):1317-1320.
[4] He Y, Coonar A, Gelvez-Zapata S, et al. Evaluation of a robot-assisted video-assisted thoracoscopic surgery programme[J]. Experimental and Therapeutic Medicine, 2014, 7(4):873-876.
[5] 牛国君.腹腔微创手术机器人系统从手机构与控制的研究[D].哈尔滨:哈尔滨工业大学,2017.Niu G J. Research on the slave mechanism and control of a medical robot system for celiac minimally invasive surgery[D]. Harbin:Harbin Institute of Technology, 2017.
[6] 马如奇.微创腹腔外科手术机器人执行系统研制及其控制算法研究[D].哈尔滨:哈尔滨工业大学,2013.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.
[7] 冯美.腹腔微创手术机器人系统关键技术研究[D].哈尔滨:哈尔滨工业大学,2012.Feng M. Research on key technologies about a medical robot for celiac minimally invasive surgery[D]. Harbin:Harbin Institute of Technology, 2012.
[8] 李建民.微创机器人机构设计方法与主从映射策略研究[D].天津:天津大学,2012.Li J M. Mechanism design and master-slave mapping strategy of minimally invasive surgical robot[D]. Tianjin:Tianjin University, 2012.
[9] 唐奥林.面向主从式微创外科手术机器人的遥操作运动控制策略研究[D].上海:上海交通大学,2014.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.
[10] Weede O, Monnich H, Muller B, et al. An intelligent and autonomous endoscopic guidance system for minimally invasive surgery[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2011:5762-5768.
[11] Staub C, Lenz C, Panin G, et al. Contour-based surgical instrument tracking supported by kinematic prediction[C]//IEEE International Conference on Biomedical Robotics and Biomechatronics. Piscataway, USA:IEEE, 2010:746-752.
[12] Tully S, Kantor G, Zenati M A, et al. Shape estimation for image-guided surgery with a highly articulated snake robot[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2010:748-753.
