Planning for Flexible Surgical Robots via Bézier Spline Translation

In a minimally invasive surgery, new flexible instruments enable safer and easier access to difficult-to-reach anatomical regions. However, their introduction into the clinical workflow requires robust replanning because navigation errors during surgery render initially planned trajectories infeasible. Such replanning requires to regularly solve an expensive two-point boundary value problem (BVP) that connects the target pose of the instrument with the currently measured one. We propose a hybrid planning scheme that features both robust and safe replanning. This two-step approach first solves the BVP and then transforms the result to circular arcs that fit the motion of our instruments’ models. We exploit implicitly defined Bézier splines as a robust method for interpolation in the first step. A novel geometric translation of these splines, then, provides a convenient solution for movement along circular arcs. We consider two example applications: 1) planning for a drilling unit in temporal bone surgery; and 2) guidewires in catheter insertion. Evaluation on real patient data of both temporal bone and aorta show that our proposed hybrid two-step approach achieves, on average, ${\text{55}\%}$ higher replanning rates and provides ${\text{31}\%}$ larger clearance to risk structures, thus improving trajectory quality with regard to clinical safety.

[1]  Georgios Sakas,et al.  Planning nonlinear access paths for temporal bone surgery , 2018, International Journal of Computer Assisted Radiology and Surgery.

[2]  B. Lindsay,et al.  Novel, Magnetically Guided Catheter for Endocardial Mapping and Radiofrequency Catheter Ablation , 2002, Circulation.

[3]  Pieter Abbeel,et al.  Planning Curvature and Torsion Constrained Ribbons in 3D With Application to Intracavitary Brachytherapy , 2015, IEEE Transactions on Automation Science and Engineering.

[4]  Riccardo Secoli,et al.  Fast and Adaptive Fractal Tree-Based Path Planning for Programmable Bevel Tip Steerable Needles , 2016, IEEE Robotics and Automation Letters.

[5]  Robert J. Webster,et al.  Safe Motion Planning for Steerable Needles Using Cost Maps Automatically Extracted from Pulmonary Images , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[6]  F Ganet,et al.  Development of a smart guide wire using an electrostrictive polymer: option for steerable orientation and force feedback , 2015, Scientific Reports.

[7]  Sangwoo Moon,et al.  Spline-Based RRT Path Planner for Non-Holonomic Robots , 2013, Journal of Intelligent & Robotic Systems.

[8]  Ron Alterovitz,et al.  Stochastic Extended LQR for Optimization-Based Motion Planning Under Uncertainty , 2016, IEEE Trans Autom. Sci. Eng..

[9]  Debasish Ghose,et al.  Optimal path planning for an aerial vehicle in 3D space , 2010, 49th IEEE Conference on Decision and Control (CDC).

[10]  Anirban Mukhopadhyay,et al.  Toward an automatic preoperative pipeline for image-guided temporal bone surgery , 2019, International Journal of Computer Assisted Radiology and Surgery.

[11]  Robert J. Webster,et al.  Motion planning for a three-stage multilumen transoral lung access system , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[12]  Dereck S. Meek,et al.  Planar G 2 transition curves composed of cubic Bézier spiral segments , 2003 .

[13]  Georgios Sakas,et al.  Minimally Invasive Multiport Surgery of the Lateral Skull Base , 2014, BioMed research international.

[14]  Salah Sukkarieh,et al.  3D smooth path planning for a UAV in cluttered natural environments , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[16]  Howie Choset,et al.  Continuum Robots for Medical Applications: A Survey , 2015, IEEE Transactions on Robotics.

[17]  Stefano Galvan,et al.  The Adaptive Hermite Fractal Tree (AHFT): a novel surgical 3D path planning approach with curvature and heading constraints , 2019, International Journal of Computer Assisted Radiology and Surgery.

[18]  Jean-Marc Chassery,et al.  Approximated Centroidal Voronoi Diagrams for Uniform Polygonal Mesh Coarsening , 2004, Comput. Graph. Forum.

[19]  Dieter W. Fellner,et al.  Generalized Trajectory Planning for Nonlinear Interventions , 2018, OR 2.0/CARE/CLIP/ISIC@MICCAI.

[20]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[21]  Robert J. Webster,et al.  Optimization of Curvilinear Needle Trajectories for Transforamenal Hippocampotomy , 2016, Operative neurosurgery.

[22]  Dinggang Shen,et al.  Segmentation of Organs at Risk in thoracic CT images using a SharpMask architecture and Conditional Random Fields , 2017, 2017 IEEE 14th International Symposium on Biomedical Imaging (ISBI 2017).

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

[24]  Timothy F. Cootes,et al.  Active Shape Models-Their Training and Application , 1995, Comput. Vis. Image Underst..

[25]  P. Pharpatara,et al.  3-D Trajectory Planning of Aerial Vehicles Using RRT* , 2017, IEEE Transactions on Control Systems Technology.

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

[27]  Ron Alterovitz,et al.  Motion planning under uncertainty for medical needle steering using optimization in belief space , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Robert J. Webster,et al.  Needle Steering in 3-D Via Rapid Replanning , 2014, IEEE Transactions on Robotics.