Three-dimensional Motion Planning Algorithms for Steerable Needles Using Inverse Kinematics

Steerable needles can be used in medical applications to reach targets behind sensitive or impenetrable areas. The kinematics of a steerable needle are non-holonomic and, in two dimensions, equivalent to a Dubins car with constant radius of curvature. In three dimensions, the needle can be interpreted as an airplane with constant speed and pitch rate, zero yaw, and controllable roll angle. We present a constant-time motion planning algorithm for steerable needles based on explicit geometric inverse kinematics similar to the classic Paden— Kahan subproblems. Reachability and path competitivity are analyzed using analytic comparisons with shortest path solutions for the Dubins car (for two dimensions) and numerical simulations (for three dimensions). We also present an algorithm for local path adaptation using null-space results from redundant manipulator theory. Finally, we discuss several ways to use and extend the inverse kinematics solution to generate needle paths that avoid obstacles.

[1]  L. Dubins On Curves of Minimal Length with a Constraint on Average Curvature, and with Prescribed Initial and Terminal Positions and Tangents , 1957 .

[2]  Rolf Klein,et al.  Competitive Strategies for Autonomous Systems , 1994, Modelling and Planning for Sensor Based Intelligent Robot Systems.

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

[4]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[5]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[6]  Kenneth Y. Goldberg,et al.  Sensorless planning for medical needle insertion procedures , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[7]  Elon Rimon,et al.  Competitive Complexity of Mobile Robot On Line Motion Planning Problems , 2004, WAFR.

[8]  Septimiu E. Salcudean,et al.  Needle steering and motion planning in soft tissues , 2005, IEEE Transactions on Biomedical Engineering.

[9]  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.

[10]  Robert J. Webster,et al.  Design Considerations for Robotic Needle Steering , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[11]  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.

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

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

[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]  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.

[16]  Vinutha Kallem,et al.  Image-guided Control of Flexible Bevel-Tip Needles , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[17]  Doug L. James,et al.  Many-worlds browsing for control of multibody dynamics , 2007, SIGGRAPH 2007.

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

[19]  Kenneth Y. Goldberg,et al.  Motion Planning in Medicine: Optimization and Simulation Algorithms for Image-Guided Procedures , 2008, Springer Tracts in Advanced Robotics.

[20]  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.

[21]  Wolfram Burgard,et al.  The Stochastic Motion Roadmap: A Sampling Framework for Planning with Markov Motion Uncertainty , 2008 .

[22]  V. Kallem,et al.  Integrated planning and image-guided control for planar needle steering , 2008, 2008 2nd IEEE RAS & EMBS International Conference on Biomedical Robotics and Biomechatronics.

[23]  Kenneth Y. Goldberg,et al.  Motion Planning Under Uncertainty for Image-guided Medical Needle Steering , 2008, Int. J. Robotics Res..

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

[25]  K. Reed,et al.  Compensating for torsion windup in steerable needles , 2008, 2008 2nd IEEE RAS & EMBS International Conference on Biomedical Robotics and Biomechatronics.

[26]  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.

[27]  Kenneth Y. Goldberg,et al.  Guiding medical needles using single-point tissue manipulation , 2009, 2009 IEEE International Conference on Robotics and Automation.

[28]  Allison M. Okamura,et al.  Feedback control for steering needles through 3D deformable tissue using helical paths , 2009, Robotics: Science and Systems.