ROBOT. Mater-slave Control Technology for Abdominal Minimally Invasive Surgery Robot and Its Experiments

Transcript

1 ROBOT Vol.34, No.6 Nov., 12 DOI.3724/SP.J , TP241 A 2-446(12) Mater-slave Control Technology for Abdominal Minimally Invasive Surgery Robot and Its Experiments PAN Bo 1,2 FU Yili 1 FENG Mei 1 WANG Shuguo 1 XU Dianguo 2 (1. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 158, China; 2. School of Electrical Engineering and Automation, Harbin Institute of Technology, Harbin 151, China) Abstract: According to task features of RMIS (robot-assisted minimally invasive surgery), based on the functional requirement analyses of master-slave control, a hardware platform of robot master-slave control system is constructed by adopting control architecture of industrial computer and motion control card. A real-time control algorithm of master-slave operation is investigated based on differential transformation method, and then the auxiliary function of master-slave control is designed. Master-slave control experiment, experiment on biological tissue and animal experiment are carried out after robot system integration. Experiments demonstrate that the system has good master-slave control performance, which satisfies the actual demand of minimally invasive surgery. Keywords: minimally invasive surgery; robot configuration; master-slave operation; animal experiment 1 Introduction cm 1 cm [1] Computer Motion AESOP [2] Zeus [3] Intuitive Surgical da Vinci [4] da Vinci 863 SS12AA4161HIT. NSRIF M5654 panbo34@163.com /12-7-/12-9-3

2 [5] A [6] [7] 2 Configuration of the robot Omega dxdydz xyz dαdβ dηdγ 4 Z O Z Z 2 3 Z 3 q 4 q Z q 2 X X 3 2 d 1 X 1 1 Y Fig.1 X dη 1 dy dz dγ X Z 4 4 q 5 5 dα dx 6 X 5 β d 7 7 θ 6 X 6 Z 5 Z6 X 7 (p Z x,p y,p z ) 7 dβ Picture of the robot s configuration 3 Mater-slave control technology xyz 7

3 USB RS232 PC / A B Fig.2 2 Hardware architecture of the master-slave control system Fig.3 dz dx dy dα dβ dη dγ dz 3 k 1 k k 2 k 3 k 4 k 5 dθ 7 dθ 8 dθ 9 dθ dθ 11 dθ 5 dθ 6 dθ Analysis on master-slave mapping for the robot [8] {o} (p x, p y, p z ) 4 {o 4 } (p x, p y, p z) {o 4 } 5 7 θ 5 θ 6 d 7 {o 4 } [ p x p y p z 1 ] T = ( T 4 ) 1[ p x p y p z 1 ] T w q j (1) w = x(q j ) j = 1,2,3 (2) x(q j + q j ) =x(q j ) + x(q j ) (q j ) q j n! n x(q j ) n (q j ) ( q j ) n (3) e x(q j + q j ) = x(q j ) + x(q j ) (q j ) q j + e (4) w q j w = x(q j + q j ) x(q j ) = J(q j ) q j + e (5)

4 J(q) e J(q) = w q j = x(q j ) q j (6) 56 7 [ ] T θ5 θ 6 d 7 = J 1 (q j ) [ ] p x p y p T z (7) e 4 ẊX m k q s s X m X s X s X m X s e J Fig.4 k 1/s kx m kx m +e J X m s e J X s J 1 (q s ) 5 T 7 q s The error feedback compensation for inverse kinematics k 1 : 1 3 : 15 : 1 q s 1/s q s k Experiment mm 8 mm 4 Optotrak Centus 5 6 Marker

5 Marker z /mm Fig The master-slave control experiment (a) x (b) y 7 Fig.7 Movement trajectory of the master manipulator Fig.6 Movement trajectory of the end of the instrument xy (a) x Fig.8 8 (b) y Movement trajectory of slave manipulator xyz 1 : 1 s 2 : 1 xyz

6 Fig.9 z /mm Fig. 3 9 Pictures of the experiment of operation on biological tissue (a) x (b) y :1 1:1 1:1 2:1 2:1 2: (c) z 4.3 x,y,z Movement trajectories of the master-slave manipulator in x,y,z directions kg 11 3 h 15 ml 25 ml 6 min 7 h Fig Conclusion Pictures of animal experiment References [1] [J] 39(2): Lin L M. The development of robot-assisted minimally invasive surgery[j]. China Medical Device Information, 3, 9(2): [2] Dankelman J. Surgical robots and other training tools in minimally invasive surgery[c]//ieee International Conference on Systems, Man and Cybernetics. Piscataway, NJ, USA: IEEE, 4: [3] Ginhoux R, Gangloff J, de Mathelin M, et al. Active filtering of physiological motion in robotized surgery using predictive control[j]. IEEE Transactions on Robotics, 5, 21(1): [4] Broeders I A M J, Ruurda J. Robotics revolutionizing surgery: The intuitive surgical Da Vinci system[j]. Industrial Robot, 1, 28(5): [5] [J]426(6): ,552. Tang C, Wang T M, Chou W S, et al. Design and realization of robot control system for neurosurgery[j]. Robot, 4, 26(6): ,

7 Conclusions References [1] Vu T D, Aycard O, Appenrodt N. Online localization and mapping with moving object tracking in dynamic outdoor environments[c]//ieee Intelligent Vehicles Symposium. Piscataway, NJ, USA: IEEE, 7: [2] Vidal R, Rashid S, Sharp C, et al. Pursuit-evasion games with unmanned ground and aerial vehicles[c]//ieee International Conference on Robotics and Automation. Piscataway, NJ, USA: IEEE, 1: [3] Huang F F, Wang L, Wang Q N, et al. Coordinated control of multiple mobile robots in pursuit-evasion games[c]// Proceedings of the American Control Conference. Piscataway, NJ, USA: IEEE, 8: [4] Wang C C, Thorpe C, Thrun S, et al. Simultaneous localization, mapping and moving object tracking[j]. International Journal of Robotics Research, 7, 26(9): [5] Wang C C, Thorpe C, Thrun S. Online simultaneous localization and mapping with detection and tracking of moving objects: Theory and results from a ground vehicle in crowded urban areas[c]//ieee International Conference on Robotics and Automation. Piscataway, NJ, USA: IEEE, 3: [6] Borrmann D, Elseberg J, Lingemann K, et al. Globally consistent 3D mapping with scan matching[j]. Robotics and Autonomous Systems, 8, 56(2): [7] [J]32(3) Wu M, Sun J Y. Extended Kalman filter based moving object tracking by mobile robot in unknown environment[j]. Robot,, 32(3): [8] [J]5(2) Wu M, Sun J Y. An interacting multiple model filtering algorithm for mobile robots to improve tracking of moving objects in unknown environments[j]. CAAL Transactions on Intelligent Systems,, 5(2): [9] Wu M, Sun J Y. Simultaneous localization, mapping and detection of moving objects with mobile robot in dynamic environments[c]//proceedings of the 2nd International Conference on Computer Engineering and Technology. Piscataway, NJ, USA: IEEE, : [] Cameron S, Probert P. Advanced guided vehicles: Aspects of the Oxford AGV project[m]. Hackensack, NJ, USA: World Scientific, [11] Bar-Shalom Y. Tracking and data association[m]. Boston, USA: TE Fortmann Academic Press, [12] Arras K O. Feature-based robot navigation in known and unknown environments[d]. Lausanne, Switzerland: Swiss Federal Institute of Technology, 3. [13] Musicki D, Evans R. Joint integrated probabilistic data association: JIPDA[J]. IEEE Transactions on Aerospace and Electronic Systems, 4, (3): [14] Musicki D, Morelande M. Gate volume estimation for target tracking[c]//proceedings of the International Conference on Information Fusion. Piscataway, NJ, USA: IEEE, 4: [15] Musicki D, Evans R, Stankovic S. Integrated probabilistic data association (IPDA)[J]. IEEE Transactions on Automatic Control, 1994, 39(6): [16] Wolf D F, Sukhatme G S. Mobile robot simultaneous localization and mapping in dynamic environments[j]. Autonomous Robots, 5, 19(1): [17] Wu M, Huang F F, Wang L, et al. A distributed multi-robot cooperative hunting algorithm based on limit-cycle[c]//proceedings of 9 International Asia Conference on Informatics in Control, Automation and Robotics. Piscataway, NJ, USA: IEEE, 9: [6] Sang H Q, Li J M, He C, et al. Evaluation of a novel robotics assisted surgery system MicroHand A[C]//Proceedings of IEEE International Conference on Robotics and Biomimetics. Piscataway, NJ, USA: IEEE, : [7] [J]1118(4): Duan X G, Guo C B, Chen C. The robotic system for cranio facial surgery[j]. Robot Technique and Application, 11, 18(4): [8] [J]1133(1): Xie Q, Pan B, Fu Y L, et al. Master-slave control technology research based on abdominal minimally invasive surgery r robot[j]. Robot, 11, 33(1):