张永德, 赵燕江, 陈浩. 斜尖柔性针在软组织中的二维路径规划[J]. 机器人, 2011, 33(6): 750-757.
引用本文: 张永德, 赵燕江, 陈浩. 斜尖柔性针在软组织中的二维路径规划[J]. 机器人, 2011, 33(6): 750-757.
ZHANG Yongde, ZHAO Yanjiang, CHEN Hao. 2D Path Planning of Bevel Tip Flexible Needle in Soft Tissue[J]. ROBOT, 2011, 33(6): 750-757.
Citation: ZHANG Yongde, ZHAO Yanjiang, CHEN Hao. 2D Path Planning of Bevel Tip Flexible Needle in Soft Tissue[J]. ROBOT, 2011, 33(6): 750-757.

斜尖柔性针在软组织中的二维路径规划

2D Path Planning of Bevel Tip Flexible Needle in Soft Tissue

  • 摘要: 针对斜尖柔性针在软组织中的2维路径规划问题,首先基于柔性针的运动特性,提出了改进的单轮车运动学模型,并利用旋量理论和指数积方程计算了运动学正解,从运动学的角度证明了穿刺直线路径的可行性.基于此运动学模型,提出了采用多种路径形式的路径规划算法,同时考虑入针姿态的优化,建立了优化目标函数.在有障碍的情况下对针的穿刺路径进行了优化计算、仿真和实验.结果证明,该算法能有效地优化全局路径,使针绕过障碍准确达到靶点.实验误差均在2mm内,证明本文提出的运动学模型符合实际运动轨迹.

     

    Abstract: Aiming at the 2D path planning problem of bevel tip flexible needle in soft tissue,an improved unicycle kinematic model is proposed for the flexible needle based on its motion characteristics,and the forward kinematics is calculated using screw theory and product of exponentials formula.The feasibility of linear puncture path is proved from the view of kinematics.Based on this kinematic model,a path planning algorithm adopting multiform paths is proposed,and the optimizing objective function is established taking into account the optimization of needle insertion pose.Then the optimal calculation,simulation and experimentation of the needle puncture path are performed in the environment with obstacles. Results show that this algorithm can effectively optimize the whole paths and make the needle steer clear of obstacles and reach the target precisely.All the errors in the experiments are within 2 mm,which proves that the kinematic model proposed accords with the actual paths.

     

/

返回文章
返回