Planning Fireworks Trajectories for Steerable Medical Needles to Reduce Patient Trauma

Accurate insertion of needles to targets in 3D anatomy is required for numerous medical procedures. To reduce patient trauma, a "fireworks" needle insertion approach can be used in which multiple needles are inserted from a single small region on the patient's skin to multiple targets in the tissue. In this paper, we explore motion planning for "fireworks" needle insertion in 3D environments by developing an algorithm based on Rapidly-exploring Random Trees (RRTs). Given a set of targets, we propose an algorithm to quickly explore the configuration space by building a forest of RRTs and to find feasible plans for multiple steerable needles from a single entry region. We present two path selection algorithms with different optimality considerations to optimize the final plan among all feasible outputs. Finally, we demonstrate the performance of the proposed algorithm with a simulation based on a prostate cancer treatment environment.