DOI QR코드

DOI QR Code

Study on Direct Teaching Algorithm for Remote Center Motion of Surgical Assistant Robot using Force/Torque Sensor

힘/토크 센서를 이용한 수술보조로봇의 원격중심운동 직접교시 알고리즘 연구

  • Kim, Minhyo (School of Mechanical Engineering, Pusan National University) ;
  • Jin, Sangrok (School of Mechanical Engineering, Pusan National University)
  • Received : 2020.08.31
  • Accepted : 2020.11.03
  • Published : 2020.11.30

Abstract

This study shows a control strategy that acquires both precision and manipulation sensitivity of remote center motion with manual traction for a surgical assistant robot. Remote center motion is an essential function of a laparoscopic surgical robot. The robot has to keep the position of the insertion port in a three-dimensional space, and general laparoscopic surgery needs 4-DoF (degree-of-freedom) motions such as pan, tilt, spin, and forward/backward. The proposed robot consists of a 6-axis collaborative robot and a 2-DoF end-effector. A 6-axis collaborative robot performs the cone-shaped trajectory with pan and tilt motion of an end-effector maintaining the position of remote center. An end-effector deals with the remaining 2-DoF movement. The most intuitive way a surgeon manipulates a robot is through direct teaching. Since the accuracy of maintaining the remote center position is important, direct teaching is implemented based on position control in this study. A force/torque sensor which is attached to between robot and end-effector estimates the surgeon's intention and generates the command of motion. The predefined remote center position and the pan and tilt angles generated from direct teaching are input as a command for position control. The command generation algorithm determines the direct teaching sensitivity. Required torque for direct teaching and accuracy of remote center motion are analyzed by experiments of panning and tilting motion.

Keywords

References

  1. S.-D. Lee, K.-H. Ahn, and J.-B. Song, "Torque control based sensorless hand guiding for direct robot teaching," 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon, South Korea, pp. 745-750, 2016, DOI: 10.1109/IROS.2016.7759135.
  2. K.-H. Ahn and J.-B. Song, "Cartesian Space Direct Teaching for Intuitive Teaching of a Sensorless Collaborative Robot," Journal of Korea Robotics Society, vol.14, no. 4, pp. 311-317, Dec., 2019, DOI: 10.7746/jkros.2019.14.4.311.
  3. A. Albu-Schaffer, S. Haddadin, Ch. Ott, A. Stemmer, T. Wimbock, and G. Hirzinger, "The DLR lightweight robot: design and control concepts for robots in human environments," Industrial Robot: the international journal of robotics research and application, vol. 34, no. 5, pp. 376-385, 2007, DOI: 10.1108/01439910710774386.
  4. C. Park, J. H. Kyung, H. M. Do, and T. Choi, "Development of direct teaching robot system," 2011 8th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI), Incheon, South Korea, pp. 730-732, 2011, DOI: 10.1109/URAI.2011.6145921.
  5. J.-H. Ahn, S. Kang, C. Cho, J. Hwang, and M. Suh, "Design of Robot Direct-Teaching Tool and Its Application to Path Generation for Die Induction Hardening," 2002 International Conference on Control, Automation and Systems (ICCAS), Jeonbuk, South Korea, pp. 2356-2360, 2002, [Online], http://www.dbpia.co.kr/journal/articleDetail?nodeId=NODE02013830.
  6. H.-J. Kim, J.-H. Back, and J.-B. Song, "Direct Teaching and Playback Algorithm for Peg-in-Hole Task using Impedance Control," Journal of Institute of Control, Robotics and Systems, vol. 15, no. 5, pp. 538-542, 2009, DOI: 10.5302/j.icros.2009.15.5.538.
  7. G. Zong, X. Pei, J. Yu, and S. Bi, "Classification and type synthesis of 1-DOF remote center of motion mechanisms," Mechanism and Machine Theory, vol. 43, no. 12, pp. 1585-1595, 2008, DOI: 10.1016/j.mechmachtheory.2007.12.008.
  8. S. Jin, S. Han, "Gain Optimization of Kinematic Control for Wire-driven Surgical Robot with Layered Joint Structure Considering Actuation Velocity Bound," Journal of Korea Robotics Society, vol. 15, no. 3, pp. 212-220, September, 2020, DOI: 10.7746/jkros.2020.15.3.212.
  9. R. M. Murray, Z. Li, and S.S. Sastry, "Wrenches and Reciprocal Screw," A Mathematical Introduction to Robotic Manipulation, 1st ed., CRC Press, 1994, ch. 2, sec. 2.5, pp. 61-69, [online] https://www.routledge.com/A-Mathematical-Introduction-to-Robotic-Manipulation/Murray/p/book/9780849379819.
  10. J. T. Wilson, T.-C. Tsao, J.-P. Hubschman, and S. Schwartz, "Evaluating Remote Centers of Motion for Minimally Invasive Surgical Robots by Computer Vision," 2010 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), Montreal, ON, Canada, pp.1413-1418, 2010, DOI: 10.1109/AIM.2010.5695924.