Kinematics Analysis and Teleoperation Technology of Multi-joint Continuum Robots

doi:10.3969/j.issn.1004-132X.2021.23.013

Abstract

Abstract: A multi-joint wire driven continuum robot was designed. The continuum robots had four bending degrees of freedom and one feeding degree of freedom. The kinematics model of the continuum robot was established， and the workspace was analyzed by MATLAB. Three master-slave mapping algorithms were designed for Geomagic Touch to realize the master-slave heterogeneous teleoperation control of continuous robots. The correctness of the master-slave control algorithm was verified by experiments， and the good bending ability of the continuum robots was shown. The experimental results show that the continuum robots have certain control accuracy and good following ability.

Key words: , continuum robot, kinematics, teleoperation, master-slave control

摘要： 设计了一种多关节线驱动连续体机器人，该机器人共有4个弯曲自由度和1个进给自由度。建立了该连续体机器人的运动学模型，利用MATLAB对其工作空间进行了分析。针对Geomagic Touch设计了三种主从映射算法，实现了连续体机器人的主从异构遥操作控制。通过实验验证了主从控制算法的正确性，展示了连续体机器人良好的弯曲能力，表明该连续体机器人具有一定的控制精度和良好的跟随能力。

关键词: 连续体机器人, 运动学, 遥操作, 主从控制

CLC Number:

TP242

JI Aihong, LIU Rongxing, CHEN Hui, SUN Ke. Kinematics Analysis and Teleoperation Technology of Multi-joint Continuum Robots[J]. China Mechanical Engineering, 2021, 32(23): 2883-2889.

吉爱红, 刘荣兴, 陈辉, 孙克. 多关节连续体机器人的运动分析与遥操作技术[J]. 中国机械工程, 2021, 32(23): 2883-2889.

References

［1］王红红，杜敬利，保宏. 肌腱驱动连续体/软体机器人控制策略［J］. 机器人， 2020， 42（5）：626-640.
WANG Honghong， DU Jingli， BAO Hong. Tendon Drive Continuum/Soft Robot Control Strategy［J］. Robot， 2020， 42（5）：626-640.
［2］ROSEN J， SEKHAR L N， GLOZMAN D， et al. Roboscope：a Flexible and Bendable Surgical Robot for Single Portal Minimally Invasive Surgery［C］∥2017 IEEE International Conference on Robotics and Automation（ICRA）. Singapore， 2017：132-139.
［3］ZHAO J， ZHENG X， ZHENG M， et al. An Endoscopic Continuum Testbed for Finalizing System Characteristics of a Surgical Robot for NOTES Procedures［C］∥2013 IEEE/ASME International Conference on Advanced Intelligent Mechatronics（AIM）. Wollongong， 2013：68-73.
［4］XU K， ZHAO J， FU M. Development of the SJTU Unfoldable Robotic System（SURS）for Single Port Laparoscopy［J］. IEEE/ASME Transactions on Mechatronics， 2015， 20（5）：2133-2145.
［5］ZHANG T， YANG L， YANG X， et al. Millimeter-scale Soft Continuum Robots for Large-angle and High-precision Manipulation by Hybrid Actuation［J］. Advanced Intelligent Systems， 2021， 3（2）：2000189.
［6］WANG M， DONG X， BA W， et al. Design， Modelling and Validation of a Novel Extra Slender Continuum Robot for In-situ Inspection and Repair in Aeroengine［J］. Robotics and Computer-Integrated Manufacturing， 2021， 67：102054.
［7］YOON H， YI B. Design of a Master Device for Controlling Multi-moduled Continuum Robots［J］. Proceedings of the Institution of Mechanical Engineers， Part C：Journal of Mechanical Engineering Science， 2017， 231（10）：1921-1931.
［8］LIU Y， ZHAO S， YANG C， et al. Design of a Teleoperated Rod-driven Continuum Robot［M］. Cham：Springer International Publishing， 2019.
［9］WU Z， LI Q， ZHAO J， et al. Design of a Modular Continuum-articulated Laparoscopic Robotic Tool with Decoupled Kinematics［J］. IEEE Robotics and Automation Letters， 2019， 4（4）：3545-3552.
［10］曹燕飞. 变刚度微创介入手术连续体机器人研究［D］. 南京：南京航空航天大学， 2019.
CAO Yanfei. Research on Continuum Robot with Variable Stiffness Minimally Invasive Interventional Surgery［D］. Nanjing：Nanjing University of Aeronautics and Astronautics， 2019.
［11］殷杰. 面向微创介入手术的连续体机器人研究［D］. 南京：南京航空航天大学， 2018.
YIN Jie. Research on Continuum Robot for Minimally Invasive Interventional Surgery［D］. Nanjing：Nanjing University of Aeronautics and Astronautics， 2018.
［12］张超. 绳驱动介入手术导管机器人系统研究［D］. 南京：南京航空航天大学， 2017.
ZHANG Chao. Research on Wire Driven Interventional Catheter Robot System［D］. Nanjing：Nanjing University of Aeronautics and Astronautics， 2017.
［13］胡海燕，王鹏飞，孙立宁，等. 线驱动连续型机器人的运动学分析与仿真［J］. 机械工程学报， 2010， 46（19）：1-8.
HU Haiyan， WANG Pengfei， SUN Lining， et al. Kinematics Analysis and Simulation of Wire Driven Continuous Robot［J］. Journal of Mechanical Engineering， 2010， 46（19）：1-8.
［14］李大为. 基于OpenHaptics的六自由度串联机器人实时控制［J］. 计算机系统应用， 2016， 25（11）：221-226.
LI Dawei. Real Time Control of 6-DOF Serial Robot Based on Openhaptics［J］. Computer System Application， 2016， 25（11）：221-226.

[1]	ZHAN Xiao-Lei, XIN Hong-Bing, HAN Shi-·Bi-De-　Lan-Te-Shi. Kinematics Simulation of MOTOMAN-HP3 Robot Based on Virtual Reality [J]. J4, 201016, 21(16): 1952-1954,1998.
[2]	ZHU Xiao, SHEN Huiping, LI Ju, LI Tao, YE Pengda, ZHU Wei. Topological Design and Performance Analysis of 3-DOF Parallel Mechanisms with Alternately Used Moving Platforms [J]. China Mechanical Engineering, 2026, 37(1): 114-125.
[3]	YANG Mingxing, SHEN Jiale, GAO Peng, ZHANG Xing, WANG Junxiang. Design of Continuum Robots and Compensation Strategies for Losses of Guide Paths [J]. China Mechanical Engineering, 2025, 36(12): 2820-2828.
[4]	WANG Xuhao, SHENG Wolong, WU Mengli, XU Yilong, ZHAO Xiaowei, CAO Yiran. Design and Kinematics Modeling of Extensible Snake-like Manipulators [J]. China Mechanical Engineering, 2025, 36(12): 2885-2893.
[5]	YIN Feng, HUANG Xin, ZHOU Jiayi. High-precision Computation of Inverse Kinematics for Redundant Robots Based on Flow Model [J]. China Mechanical Engineering, 2025, 36(12): 2960-2967.
[6]	Jiaxiang DONG, Quanquan LIU, Xiping HU, Xuezhi ZHAO. Kinematic Modeling of a Novel Rigid⁃Flexible Hybrid Continuum Robots [J]. China Mechanical Engineering, 2025, 36(11): 2678-2684.
[7]	Ningning HUANG, Jingjing YOU, Pengda YE, Huiping SHEN, Chenggang LI, Hongtao WU. Forward Kinematics and Singularity of Kinematically Decoupled Stewart-type Parallel Mechanisms [J]. China Mechanical Engineering, 2025, 36(09): 1951-1960.
[8]	ZHENG Chao, LIU Jianchao, WU JunXUE Xin. Vibration Reduction Analysis of All-metal Multi-directional Isolation Devices [J]. China Mechanical Engineering, 2025, 36(07): 1463-1470.
[9]	ZHAO Tingqi1, CHENG Hongyu2, SUN Maokai1, WANG Shenghai1, WANG Haoran1, CHEN Haiquan1. Nonlinear Stability Control of Multi-cable Anti-sway Systems for Marine Cranes [J]. China Mechanical Engineering, 2025, 36(07): 1487-1496.
[10]	ZHANG Jianyu, WANG Liuzhen, XIAO Yong, MA Yanan. Fusion of Degradation Feature Information and Remaining Life Prediction for Rolling Bearings [J]. China Mechanical Engineering, 2025, 36(07): 1553-1561.
[11]	. Geometric Feature Modeling and Assembly Interference Detection Method for Large Ship Components [J]. China Mechanical Engineering, 2025, 36(07): 1636-1649.
[12]	WANG Zhichao1, LIU Chao1, RAN Yan2, CHEN Yifan3, JIANG Dongxiang1, ZHANG Genbao2, 3. A Reliability Allocation Method Considering Distribution and Transmission Models for Mechanical Systems [J]. China Mechanical Engineering, 2025, 36(06): 1143-1150.
[13]	LIU Wei1, 2, CHANG Jiaqi1, 2, LI Boxin1, 2, YAN Can1, 2, DENG Zhaohui3, WAN Linlin1, 2. Influences of MCMBs on Electrolytic Dressing and Grinding Performances of Multi-layer Brazed Diamond Grinding Wheels [J]. China Mechanical Engineering, 2025, 36(06): 1151-1158.
[14]	GAO Guanbin1, 2, ZHAO Siguo1, 2, LI Yingjie1, 2. Modeling and Identification of Robot End-payloads Based on Joint Torque Balance [J]. China Mechanical Engineering, 2025, 36(06): 1188-1197.
[15]	LIN Shuwen, LU Zhe, WEI Shijia, CHEN Jianxiong, GU Tianqi, XIE Yu. Simulation of Dynamic Characteristics of Excavator Working Processes and Multi-objective Optimization Design Method of Main Component Parameters [J]. China Mechanical Engineering, 2025, 36(06): 1371-1379.