Reverse Path Planning for Flexible Needle in 2D Soft Tissue with Obstacles

In clinic it is of very practical significance to optimize the entry point and pose in path planning. We proposed a reverse path planning algorithm adopting multiform combined paths based on the improved kinematic model of flexible needle, and the objective function is established. Utilizing the reversibility of the path, we started from the target to optimize the whole path including the entry point and pose. Then we optimally calculated and simulated in the environment with obstacles. Results show that this algorithm effectively makes the needle steer clear of obstacles to reach the target precisely, and gains the entry point and pose at the same time, guaranteeing the optimal path.

[1]  Yong-de Zhang,et al.  Kinematic Modeling of Bevel Tip Flexible Needle , 2010, ICIRA.

[2]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[3]  Jin Seob Kim,et al.  Diffusion-Based Motion Planning for a Nonholonomic Flexible Needle Model , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[4]  Gregory S. Chirikjian,et al.  Kinematic state estimation and motion planning for stochastic nonholonomic systems using the exponential map , 2008, Robotica.

[5]  J. Adam M. Cunha,et al.  Planning fireworks trajectories for steerable medical needles to reduce patient trauma , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Thierry Siméon,et al.  The Stochastic Motion Roadmap: A Sampling Framework for Planning with Markov Motion Uncertainty , 2007, Robotics: Science and Systems.

[7]  D. Minhas,et al.  Modeling of Needle Steering via Duty-Cycled Spinning , 2007, 2007 29th Annual International Conference of the IEEE Engineering in Medicine and Biology Society.

[8]  Allison M. Okamura,et al.  Planning for Steerable Bevel-tip Needle Insertion Through 2D Soft Tissue with Obstacles , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[9]  S. Shankar Sastry,et al.  3D Motion Planning Algorithms for Steerable Needles Using Inverse Kinematics , 2008, WAFR.

[10]  Jin Seob Kim,et al.  Nonholonomic Modeling of Needle Steering , 2006, Int. J. Robotics Res..

[11]  Ron Alterovitz,et al.  Interactive motion planning for steerable needles in 3D environments with obstacles , 2010, 2010 3rd IEEE RAS & EMBS International Conference on Biomedical Robotics and Biomechatronics.

[12]  Zhang Yongde,et al.  Kinematic modeling of bevel tip flexible needle , 2010, ICIRA 2010.

[13]  Kenneth Y. Goldberg,et al.  Motion planning for steerable needles in 3D environments with obstacles using rapidly-exploring Random Trees and backchaining , 2008, 2008 IEEE International Conference on Automation Science and Engineering.

[14]  C.N. Riviere,et al.  Toward Effective Needle Steering in Brain Tissue , 2006, 2006 International Conference of the IEEE Engineering in Medicine and Biology Society.

[15]  Kenneth Y. Goldberg,et al.  Constant-Curvature Motion Planning Under Uncertainty with Applications in Image-Guided Medical Needle Steering , 2006, WAFR.

[16]  Gregory S. Chirikjian,et al.  Steering flexible needles under Markov motion uncertainty , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  S. Shankar Sastry,et al.  Screw-based motion planning for bevel-tip flexible needles in 3D environments with obstacles , 2008, 2008 IEEE International Conference on Robotics and Automation.