Safety Strategy of Surgical Robot Admittance Control Based on Virtual Fixtures
TANG Yucun1, ZHANG Jianfa2, WU Shuai1, SUN Fenglong3, KUANG Shaolong1, SUN Lining1
1. School of Mechanical and Electrical Engineering, Soochow University, Suzhou 215000, China;
2. Suzhou Suxiang Robot and Intelligent Equipment Research Institute, Suzhou 215000, China;
3. Shanghai Electric Group Company Limited Central Research Institute, Shanghai 200070, China
Abstract:A strategy of the admittance control based on virtual fixtures is proposed to solve the potential safety problem caused by the incorrect operation of the doctor and the complexity of the surgical space during the human-robot cooperative surgery. The tube virtual fixtures, the cone virtual fixtures and the forbidden-region virtual fixtures based on artificial potential field are designed according to the principle of admittance control and the features of drag-guided phase, precise positioning phase, surgical operation phase in human-robot cooperative surgery. And the simulation experiments of knee replacement surgery are carried out on the self-developed surgical robot. The results show that the tube virtual fixtures can effectively assist the robot move along the trajectory; The cone virtual fixtures can effectively reduce the positioning error of the doctor dragging the robot, and the positioning error is 0.23 mm; The forbidden-region virtual fixtures can effectively prevent the robot from crossing the operation area and ensure the safety of the surgical operation.
[1] Moon Y W, Ha C W, Do K H, et al. Comparison of robot-assisted and conventional total knee arthroplasty:A controlled cadaver study using multiparameter quantitative three-dimensional CT assessment of alignment[J]. Computer Aided Surgery, 2012, 17(2):86-95.
[2] Fleischut P M, Eskreiswinkler J M, Gaberbaylis L K, et al. Variability in anesthetic care for total knee arthroplasty an analysis from the anesthesia quality institute[J]. American Journal of Medical Quality, 2015, 30(2):172-179.
[3] Liow M H, Chin P L, Tay K J, et al. Early experienceswith robot-assisted total knee arthroplasty using the Digi-MatchTM ROBODOC® surgical system[J]. Singapore Medical Journal, 2014, 55(10):529-534.
[4] Baena F R Y, Davies B. Robotic surgery:From autonomous systems to intelligent tools[J]. Robotica, 2010, 28(Sl):163-170.
[5] Osa T, Uchida S, Sugita N, et al. Hybrid control of master-slave velocity control and admittance control for safe remote surgery[C]//IEEE/RSJ International Conference on IntelligentRobots and Systems. Piscataway, USA:IEEE, 2014:1328-1334.
[6] 宋国立,韩冰,赵忆文,等.脊柱微创手术机器人速度场控制方法[J].机器人,2016,38(5):603-611.Song G L, Han B, Zhao Y W, et al. Velocity field control method of a minimally invasive spine surgical robot[J]. Robot, 2016, 38(5):603-611.
[7] Liu D, Wang T, Tang C, et al. A hybrid robot system for CT-guided surgery[J]. Robotica, 2010, 28(Sl):253-258.
[8] Tarwala R, Dorr L D. Robotic assisted total hip arthroplasty using the MAKO platform[J]. Current Reviews in Musculoskeletal Medicine, 2011, 4(3):151-156.
[9] Kuang S L, Tang Y C, Li A D, et al. Intelligent control for human-robot cooperation in orthopedics surgery[M]//Advances in Experimental Medicine and Biology, Vol.1093. Berlin, Germany:Springer, 2018:245-262.
[10] Lin H C, Mills K, Kazanzides P, et al. Portability and applicability of virtual fixtures across medical and manufacturing tasks[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2006:225-230.
[11] 蒋再男,刘宏,谢宗武,等.3D图形预测仿真及虚拟夹具的大时延遥操作技术[J].西安交通大学学报,2008,42(1):78-81.Jiang Z N, Liu H, Xie Z W, et al. Teleoperation with large time delay based on 3D graphic predictive simulation and virtual fixture[J]. Journal of Xi'an Jiaotong University, 2008, 42(1):78-81.
[12] Rosenberg L B. Virtual fixtures:Perceptual tools for telerobotic manipulation[C]//IEEE Virtual Reality Conference. Piscataway, USA:IEEE, 1993:76-82.
[13] Abbott J J, Marayong P, Okamura A M, et al. Haptic virtual fixtures for robot-assisted manipulation[M]//Springer Tracts in Advanced Robotics, Vol.28. Berlin, Germany:Springer, 2007:49-64.
[14] 韩亚丽,许有熊,高海涛,等.基于导纳控制的膝关节外骨骼摆动控制研究[J].自动化学报,2016,42(12):1943-1950.Han Y L, Xu Y X, Gao H T, et al. Knee joint exoskeleton swing control with admittance control[J]. Acta Automatica Sinica, 2016, 42(12):1943-1950.
[15] Dimeas F, Aspragathos N A. Fuzzy learning variable admittance control for human-robot cooperation[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2014:4770-4775.
[16] Bowyer S A, Davies B L, Baena F R, et al. Active constraints/virtual fixtures:A survey[J]. IEEE Transactions on Robotics, 2014, 30(1):138-157.
[17] Yao B T, Zhou Z D, Wang L H, et al. Sensorless and adaptive admittance control of industrial robot in physical human-robot interaction[J]. Robotics and Computer-integrated Manufacturing, 2018, 51:158-168.
[18] Ernesto Solanes J, Gracia L, Munoz-Benavent P, et al. Adaptive robust control and admittance control for contact-driven robotic surface conditioning[J]. Robotics and Computer-integrated Manufacturing, 2018, 54:115-132.
[19] Augugliaro F, D'Andrea R. Admittance control for physical human-quadrocopter interaction[C]//European Control Conference. Piscataway, USA:IEEE, 2013:1805-1810.
[20] Passenberg C, Peer A, Buss M, et al. A survey of environment-,operator-, and task-adapted controllers for teleoperation sys-tems[J]. Mechatronics, 2010, 20(7):787-801.
[21] Karaman S, Frazzoli E. Sampling-based algorithms for optimal motion planning[J]. International Journal of Robotics Research, 2011, 30(7):846-894.
[22] Dimeas F, Aspragathos N A. Fuzzy learning variable admittance control for human-robot cooperation[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA:IEEE, 2014:4770-4775.
[23] Flash T, Hogan N. The coordination of arm movements:An experimentally confirmed mathematical model[J]. Journal of Neuroscience, 1985, 5(7):1688-1703.
[24] Prada R, Payandeh S. On study of design and implementation of virtual fixtures[J]. Virtual Reality, 2009, 13(2):117-129.