A Compliant Control of a Colonoscopy Robot Based on Force Sensing
FENG Xiaoxiao, HU Haiyan, LI Longwei, LI Weida, SUN Lining
Collaborative Innovation Center of Suzhou Nano Science and Technology, School of Mechanical and Electric Engineering, Soochow University, Suzhou 215021, China
冯笑笑, 胡海燕, 李龙委, 李伟达, 孙立宁. 基于力感知的结肠镜机器人柔顺控制[J]. 机器人, 2016, 38(2): 217-224.DOI: 10.13973/j.cnki.robot.2016.0217.
FENG Xiaoxiao, HU Haiyan, LI Longwei, LI Weida, SUN Lining. A Compliant Control of a Colonoscopy Robot Based on Force Sensing. ROBOT, 2016, 38(2): 217-224. DOI: 10.13973/j.cnki.robot.2016.0217.
As the position and shape of human intestinal canal are unfixed for reason of the relative floating property of canal, a compliant control method for colonoscopy robots based on force sensing is proposed to improve the safety and reliability of the endoscopy. Firstly, the force sensor mounted on the colonoscopy robot is analyzed and designed according to the robot surface structure. Then, a compliant control algorithm is proposed based on the analyses on biomechanical characteristics of the intestinal canal and the coupling relationship between the robot joints. Finally, a robot control system is built to verify the feasibility of the algorithm by experiment. And experimental results show that the colonoscopy robot's ability to sense the contact pressure on intestinal canal is improved with the proposed method, which ensures the pressure value is within the threshold, and thus the security and reliability of the intestinal inspection are improved.
[1] 赫捷, 陈万青.2012 中国肿瘤登记年报[M].北京:军事医学科学出版社, 2012:12.He J, Chen W Q. 2012 Chinese cancer registry annual report[M]. Beijing: Military Medical Science Press, 2012: 12.[2] 李祖平, 张诚, 谭咏梅.结肠镜单人操作技术临床运用的探讨[J].中国内镜杂志, 2005, 11(2):222-224.Li Z P, Zhang C, Tan Y M. Discussion on clinical application of single operation technique of colonoscopy[J]. China Journal of Endoscopy, 2005, 11(2): 222-224.[3] Bajo A, Simaan N. Finding lost wrenches: Using continuum robots for contact detection and estimation of contact location[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2010: 3666-3673.[4] Chena G, Pham M T, Redarce T, et al. Sensor-based guidance control of a continuum robot for a semi-autonomous[J]. Robotics and Autonomous Systems, 2009, 57(6/7): 712-722.[5] Lobaton E J, Fu J H, Torres L G, et al. Continuous shape estimation of continuum robots using X-ray images[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2013: 725-732.[6] 殷跃红, 朱剑英, 尉忠信.机器人力控制研究综述[J].南京航空航天大学学报, 1997, 29(2):220-230.Yin Y H, Zhu J Y, Wei Z X. Force control of robot: An overview[J]. Journal of Nanjing University of Aeronautics and Astronautics, 1997, 29(2): 220-230.[7] Feng X X, Hu H Y, Zhang H M, et al. Research on force sensing system for a colonoscopy robot[C]//IEEE International Conference on Mechatronics and Automation. Piscataway, USA: IEEE, 2015: 755-760.[8] 冯元帧.生物力学[M].湖南:湖南科学技术出版社, 1986:222-225.Feng Y Z. Biomechanics[M]. Hu'nan: Hunan Science and Technology Press, 1986: 222-225.[9] 牛治军, 牛明星.肛肠病临床与生物力学[M].北京:人民卫生出版社, 2002:39-45.Niu Z J, Niu M X. Clinical medicine and biomechanics of anorectal disease[M]. Beijing: People's Medical Publishing House, 2002: 39-45.[10] 吴江红, 程西云, 韦云隆, 等.猪十二指肠和空肠生物力学性能特性[J].重庆大学学报, 2001, 24(2):9-11.Wu J H, Chen X Y, Wei Y L, et al. Study on contact of loaded hourglass worm gearing[J]. Journal of Chongqing University: Natural Science Edition, 2001, 24(2): 9-11.[11] 周丁华, 赵玮, 闫涛, 等.人体肠道生物力学特性的研究[J].生物医学工程杂志, 2006, 23(5):1017-1019.Zhou D H, Zhao W, Yan T, et al. Study on the biomechanical behavior of human intestine[J]. Journal of Biomedical Engineering, 2006, 23(5): 1017-1019.[12] Niku S B. 机器人学导论[M].北京:电子工业出版社, 2004:34-51.Niku S B. Introduction to robotics[M]. Beijing: Publishing House of Electronics Industry, 2004: 34-51.