Design of Master-Slave Operation Robot Based on Impedance Control in Minimally Invasive Spinal Surgery
LU Ming1,2, ZHAO Yiwen1, JIANG Yunxiang1
1. The State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China;
2. University of Chinese Academy of Sciences, Beijing 100049, China
Abstract:Aiming at the robot systems for minimally invasive spine surgery (MTSS), an impedance control strategy suitable for double systems is put forward, and related analysis and experimental research are carried out. Firstly, the relationship between the end-effector and the joint angle is obtained through kinematics calculation. Then, conversion formula between the force and the position is deduced based on the impedance relationship model. Finally, the actual angle of each joint is calculated through position control. This paper solves the coordination control problems of force and position, improves the accuracy of force and position control in MTSS robots, ensures the position and force consistency between the master and slave robots, and makes the master robot reproduce states of the slave robot accurately. At the operation level, the proposed system can save the doctor from long-term heavy operation and improve the operation accuracy and final effect of MTSS.
[1] Beelen M J, Naus G J L, van de Molengraft M J G, et al. Force feedback control design for nonideal teleoperators[J]. Control Engineering Practice, 2013, 21(12): 1694-1705.
[2] 韩建达,宋国立,赵忆文,等.脊柱微创手术机器人研究现状 [J].机器人技术与应用,2011(4):24-27.Han J D, Song G L, Zhao Y W, et al. Research status of the minimally invasive spinal surgical robots[J].\columnbreak Robot Technique and Application, 2011(4): 24-27.
[3] 常健,王亚珍,李斌.基于力/位混合算法的 7 自由度机械臂精细操控方法 [J].机器人,2016,38(5):531-539.Chang J, Wang Y Z, Li B. Accurate operation control method based on hybrid force/position algorithm for 7-DOF manipulator[J]. Robot, 2016, 38(5): 531-539.
[4] 宋国立,韩冰,赵忆文,等.脊柱微创手术机器人速度场控制方法 [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.
[5] 张庭,姜力,刘宏.仿生假手抓握力控制策略 [J].机器人,2012,34(2):190-196.Zhang T, Jiang L, Liu H. A grasping force control strategy for anthropomorphic prosthetic hand[J]. Robot, 2012, 34(2): 190-196.
[6] Zhang P, Yu S C, Hu Y, et al. Design of a novel master-slave robotic system for minimally intravascular invasive surgery[C]// IEEE International Conference on Mechatronics and Automation. Piscataway, USA: IEEE, 2011: 259-264.
[7] Sung G T, Gill I S, Hsu T H S. Robotic-assisted laparoscopic pyeloplasty: A pilot study[J]. Urology, 1999, 53(6): 1099-1103.
[8] Rassweiler J J, Goezen A S, Jalal A A, et al. A new platform improving the ergonomics of laparoscopic surgery: Initial clinical evaluation of the prototype[J]. European Urology, 2012, 61(1): 226-229.
[9] van den Bedem L, Hendrix R, Rosielle N, et al. Design of a minimally invasive surgical teleoperated master-slave system with haptic feedback[C]// IEEE International Conference on Mechatronics and Automation. Piscataway, USA: IEEE, 2009: 60-65.
[10] Stevens B S. Control characterisation and optimisation of fast industrial robots (an application to the direct drive DELTA parallel robot)[D]. Lausanne, Switzerland: EPFL, 1996.
[11] Clavel R. DELTA, a fast robot with parallel geometry[C]//18th International Symposium on Industrial Robots. Kempston, UK: IFS Publications, 1988: 91-100.
[12] Liu K, Fitzgerald J M, Lewis F L. Kinematic analysis of a Stewart platform manipulator[J]. IEEE Transactions on Industrial Electronics, 1993, 40(2): 282-293.
[13] Yee C S, Lim K B. Forward kinematics solution of Stewart platform using neural networks[J]. Neurocomputing, 1997, 16(4): 333-349.
[14] Bonev I A, Ryu J. A new method for solving the direct kinematics of general 6-6 Stewart platforms using three linear extra sensors[J]. Mechanism and Machine Theory, 2000, 35(3): 423-436.
[15] Nanua P, Waldron K J, Murthy V. Direct kinematic solution of a Stewart platform[J]. IEEE Transactions on Robotics and Automation, 1990, 6(4): 438-444.
[16] Zhang C D, Song S M. Forward kinematics of a class of parallel (Stewart) platforms with closed-form solutions[J]. Journal of Robotic Systems, 1992, 9(1): 93-112.