Design of master-slave control system with vibration suppression for minimally invasive surgical robot

doi:10.3778/j.issn.1002-8331.1606-0411

Computer Engineering and Applications ›› 2018, Vol. 54 ›› Issue (1): 235-239.DOI: 10.3778/j.issn.1002-8331.1606-0411

Previous Articles Next Articles

Design of master-slave control system with vibration suppression for minimally invasive surgical robot

YANG Chenghao1, SANG Hongqiang1，2, LIU Fen1, YUN Jintian1, CHEN Fa1

1.School of Mechanical Engineering, Tianjin Polytechnic University, Tianjin 300387, China
2.Tianjin Key Laboratory of Advanced Mechatronic Equipment Technology, Tianjin 300387, China

Online:2018-01-01 Published:2018-01-15

具有震颤抑制的微创机器人主从控制系统设计

杨铖浩1，桑宏强1，2，刘芬1，贠今天1，陈发1

1.天津工业大学机械工程学院，天津 300387
2.天津市现代机电装备技术重点实验室，天津 300387

Abstract

Abstract: A master-slave control system of the minimally invasive surgical robot is proposed for vibration suppression. The new Zero-Phase Filter（ZPF） and the Feed Forward PD（FFPD） algorithm are proposed, which aims to alleviate the physiological hand tremor and the “stick slip”behavior of salve manipulator, respectively. The new ZPF avoids the time delay which the traditional PD controller causes as well as the problem that conventional zero-phase filter cannot be used online, while the FFPD controller overcomes the disadvantage that the nonlinear friction torque exerts a negative effect on the performance of salve manipulator. Finally, simulations and experiments show that the method can effectively suppress the vibration phenomenon at the tip of surgical instrument.

Key words: minimally invasive surgical robot, kinematics, master-slave control system, zero-phase filter, friction compensation

摘要： 详述了一种用于抑制微创手术机器人震颤现象的主从控制系统，提出了针对人手生理震颤的新型零相位滤波方法及针对从操作臂关节“粘滑行为”的前馈补偿PD伺服算法。新型零相位滤波避免了传统低通滤波器容易造成延时和传统零相位滤波无法在线使用的缺点，前馈补偿PD伺服算法通过摩擦补偿克服了非线性摩擦对从操作臂运动造成的影响。最后，对系统进行仿真及实验，结果表明该方法能有效地抑制机器人手术工具末端的震颤现象。

关键词: 微创手术机器人, 运动学, 主从控制系统, 零相位滤波, 摩擦补偿

YANG Chenghao1, SANG Hongqiang1，2, LIU Fen1, YUN Jintian1, CHEN Fa1. Design of master-slave control system with vibration suppression for minimally invasive surgical robot[J]. Computer Engineering and Applications, 2018, 54(1): 235-239.

杨铖浩1，桑宏强1，2，刘芬1，贠今天1，陈发1. 具有震颤抑制的微创机器人主从控制系统设计[J]. 计算机工程与应用, 2018, 54(1): 235-239.

[1]	DAI Yaonan, CHEN Xubing. Design and Implementation of Moxibustion Robot with Constant Temperature on Human Back Spine [J]. Computer Engineering and Applications, 2019, 55(9): 216-222.
[2]	ZHU Jingwei, FANG Husheng, SHAO Faming, JIANG Chengming. Self-Adaptive Particle Swarm Optimization Algorithm for Solving Inverse Kinematics Problem of Redundant Manipulator [J]. Computer Engineering and Applications, 2019, 55(14): 215-220.
[3]	XIE Hong, XIANG Qijun, CHEN Haibin, ZHANG Xiaogang, YANG Peng, ZHANG Ailin, LI Yunfeng. Inverse kinematics solution algorithm of robot based on differential algorithm and adaptive chaotic particle swarm optimization [J]. Computer Engineering and Applications, 2017, 53(8): 126-131.
[4]	SANG Hongqiang1，2, CHEN Fa1, LIU Fen1, YANG Chenghao1, XU Liping1. Branch analysis method for kinematics of steel cable-driven robot [J]. Computer Engineering and Applications, 2017, 53(4): 45-50.
[5]	HAN Fenglin1，2, JIANG Xiaolei1，2, YAN Hongzhi1，2. Robotic TCP calibration method based on plane toolbar with distance measure function [J]. Computer Engineering and Applications, 2016, 52(18): 18-23.
[6]	HE Yuanlie, XU Kou. Particle swarm neural network solution to inverse kinematics of underactuated planar robot [J]. Computer Engineering and Applications, 2016, 52(17): 54-58.
[7]	HAN Hongwei1, DANG Shuwen2, HE Fajiang2. Structural design and research work on simulation of flight simulator [J]. Computer Engineering and Applications, 2016, 52(13): 254-258.
[8]	HAN Dawei, ZHAO Mei, LI Wei, SHENG Wugang. Study on identification modeling method for friction nonlinear servo system [J]. Computer Engineering and Applications, 2015, 51(5): 247-250.
[9]	REN Wu, ZHANG Zhaowei, WU Yunxin. Mobile concrete pump boom multibody kinematics simulation and experimental research [J]. Computer Engineering and Applications, 2014, 50(14): 233-237.
[10]	CHEN Lei, ZHANG Guoliang, ZHANG Weiping, JING Bin. Dynamic gait planning of robot NAO [J]. Computer Engineering and Applications, 2014, 50(1): 267-270.
[11]	WEN Peixian1, ZHENG Baoling1, GONG Liang1, DU Xiaorong1, YANG Lin2, LAI Gengwei2. Method to extract and retarget the character motion trajectory [J]. Computer Engineering and Applications, 2012, 48(9): 189-191.
[12]	YU Junwei1, LIU Nan2, ZHANG Dexian1, WANG Feng1. Type recognition of anti-ship missiles based on Bayesian network [J]. Computer Engineering and Applications, 2012, 48(9): 215-217.
[13]	PEI Jiufang1，2, WANG Hai1，2, XU Dezhang1，2. Tracking control of mobile robot based on iterative learning control [J]. Computer Engineering and Applications, 2012, 48(9): 222-225.
[14]	RUI Ting，ZHU Jing-wei，JIANG Xin-sheng，LIAO Ming. Solving PUMA robot inverse kinematics based on simulated annealing particle swarm optimization [J]. Computer Engineering and Applications, 2010, 46(3): 27-29.
[15]	ZHANG Wan-xu，ZHANG Jian-bin，ZHANG Yuan. Structure design of amphibious robot and kinematics modeling [J]. Computer Engineering and Applications, 2010, 46(10): 60-63.

Design of master-slave control system with vibration suppression for minimally invasive surgical robot

具有震颤抑制的微创机器人主从控制系统设计

PDF

Knowledge

Abstract

Cite this article

share this article

References

Related Articles 15

Recommended Articles

Metrics