Diffusion-Based Motion Planning for a Nonholonomic Flexible Needle Model

Fine needles facilitate diagnosis and therapy because they enable minimally invasive surgical interventions. This paper formulates the problem of steering a very flexible needle through firm tissue as a nonholonomic kinematics problem, and demonstrates how planning can be accomplished using diffusion-based motion planning on the Euclidean group, SE(3). In the present formulation, the tissue is treated as isotropic and no obstacles are present. The bevel tip of the needle is treated as a nonholonomic constraint that can be viewed as a 3D extension of the standard kinematic cart or unicycle. A deterministic model is used as the starting point, and reachability criteria are established. A stochastic differential equation and its corresponding Fokker-Planck equation are derived. The Euler-Maruyama method is used to generate the ensemble of reachable states of the needle tip. Inverse kinematics methods developed previously for hyper-redundant and binary manipulators that use this probability density information are applied to generate needle tip paths that reach the desired targets.

[1]  H. McKean.  STOCHASTIC INTEGRAL EQUATIONS ( d = 1) , 1969 .

[2]  D. Mayne,et al.  Geometric Methods in System Theory , 1973 .

[3]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

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

[5]  Gregory S. Chirikjian,et al.  Inverse kinematics of discretely actuated hyper-redundant manipulators using workspace densities , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[6]  Janusz,et al.  Geometrical Methods in Robotics , 1996, Monographs in Computer Science.

[7]  Gregory S. Chirikjian,et al.  Numerical convolution on the Euclidean group with applications to workspace generation , 1998, IEEE Trans. Robotics Autom..

[8]  Mark H. Overmars,et al.  Multilevel Path Planning for Nonholonomic Robots Using Semiholonomic Subsystems , 1998, Int. J. Robotics Res..

[9]  G. Chirikjian,et al.  Engineering Applications of Noncommutative Harmonic Analysis: With Emphasis on Rotation and Motion Groups , 2000 .

[10]  Desmond J. Higham,et al.  An Algorithmic Introduction to Numerical Simulation of Stochastic Differential Equations , 2001, SIAM Rev..

[11]  Toshikatsu Washio,et al.  A Model for Relations between Needle Deflection, Force, and Thickness on Needle Penetration , 2001, MICCAI.

[12]  Gregory S. Chirikjian,et al.  A diffusion-based algorithm for workspace generation of highly articulated manipulators , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[13]  Allison M. Okamura,et al.  Modeling of needle insertion forces for robot-assisted percutaneous therapy , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[14]  Joel W. Burdick,et al.  Trajectory planning using reachable-state density functions , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[15]  Septimiu E. Salcudean,et al.  Needle insertion modeling and simulation , 2003, IEEE Trans. Robotics Autom..

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

[17]  Septimiu E. Salcudean,et al.  Needle Steering and Model-Based Trajectory Planning , 2003, MICCAI.

[18]  G. Chirikjian,et al.  Nonholonomic Motion Planning Using Diffusion of Workspace Density Functions , 2003 .

[19]  Gregory S. Chirikjian,et al.  Probabilistic models of dead-reckoning error in nonholonomic mobile robots , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[20]  Allison M. Okamura,et al.  Robotic needle insertion: effects of friction and needle geometry , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[21]  Gregory S. Chirikjian,et al.  Nonholonomic Modeling of Needle Steering , 2006, Int. J. Robotics Res..

[22]  Daniel Glozman,et al.  Flexible Needle Steering and Optimal Trajectory Planning for Percutaneous Therapies , 2004, MICCAI.

[23]  Robert Rohling,et al.  Hand-held steerable needle device , 2005 .

[24]  Robert Rohling,et al.  Hand-held steerable needle device , 2003, IEEE/ASME Transactions on Mechatronics.