基于粒子群优化方法的同心管连续型机器人运动学算法  

Kinematics Algorithm of Continuous Concentric-tube Robot Based on Particle Swarm Optimization

作　　者：谢红[1] 王涛[1] 沈越锋 汪旭红[1] 何斌[2] 程黎明[3] 

机构地区：[1]同济大学机械与能源工程学院,上海201804 [2]同济大学电子与信息工程学院,上海201804 [3]同济大学附属同济医院,上海200065

出　　处：《机械科学与技术》2015年第1期1-7,共7页Mechanical Science and Technology for Aerospace Engineering

基　　金：上海市科委科技攻关重点项目(11JC1412100)资助

摘　　要：针对一种应用于微创手术的同心管连续型机器人运动学算法展开研究,通过几种不同运动学算法比较,在兼顾精度以及计算复杂程度的前提下,选用最小能量法建立其运动学数学模型,并选择利用粒子群优化算法强大的寻优能力对相关能量函数寻求最优解。建立了从驱动空间参数到关节空间所有参数的映射关系,通过坐标变换和参数拟合,得到同心管连续型机器人从基点到末端点空间姿态的表达式。通过运动学算例和三维模型的运动学仿真获得的运动轨迹进行对比验证,说明了算法模型的可行性和准确性。Aiming at the kinematics algorithm study of the concentric tube continuous robot applied in minimally invasive surgery,this paper compares several different kinematics algorithms and selects the minimum energy method to establish the kinematics mathematical model on the premise of both accuracy and computational complexity. Then the particle swarm optimization algorithm is used to optimize relevant energy function for the optimal solution because of its powerful optimization ability. Finally,the mapping relation of all parameters from drive space to joint space is set up,and the posture expression from basis point to end point of the robot is obtained through coordinate transformation and parameters fitting. At last,this paper compares the simulation results with the algorithm model by the use of Adams kinematics simulation,which shows the feasibility and accuracy of the kinematics model.

关 键 词：同心管 连续型机器人 最小能量法 粒子群优化方法 运动学 

分 类 号：TP242[自动化与计算机技术—检测技术与自动化装置]