Abstract
We consider a variant of nonholonomic motion planning for a Dubins car with no reversals, binary left/right steering, and uncertainty in motion direction. We develop a new motion planner and apply it to steerable needles, a new class of flexible bevel-tip medical needles that clinicians can steer through soft tissue to reach targets inaccessible to traditional stiff needles. Our method explicitly considers uncertainty in needle motion due to patient differences and the difficulty in predicting needle/tissue interaction: the planner computes optimal turning points to maximize the probability that the needle will reach the desired target. Given a medical image with segmented obstacles and target, our method formulates the planning problem as a Markov Decision Process (MDP) based on an efficient discretization of the state space, models motion uncertainty using probability distributions, and computes turning points to maximize the probability of successfully reaching the target using infinite horizon Dynamic Programming (DP). This approach has three features particularly beneficial for medical planning problems. First, the planning formulation only requires parameters that can be directly extracted from images. Second, we can compute the optimal needle insertion point by examining the DP look-up table of optimal controls for every needle state. Third, intra-operative medical imaging can be combined with the pre-computed DP look-up table to permit optimal control of the needle in the operating room without requiring time-consuming intra-operative re-planning. We apply the method to generate motion plans for steerable needles to reach targets inaccessible to stiff needles and illustrate the importance of considering uncertainty during motion plan optimization.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Preview
Unable to display preview. Download preview PDF.
References
Agarwal, P.K., Biedl, T., Lazard, S., Robbins, S., Suri, S., Whitesides, S.: Curvature-constrained shortest paths in a convex polygon. SIAM J. Comput. 31(6), 1814–1851 (2002)
Alagoz, O., Maillart, L.M., Schaefer, A.J., Roberts, M.: The optimal timing of living-donor liver transplantation. Management Science 50(10), 1420–1430 (2005)
Alterovitz, R., Goldberg, K., Okamura, A.: Planning for steerable bevel-tip needle insertion through 2D soft tissue with obstacles. In: Proc. IEEE Int. Conf. on Robotics and Automation, pp. 1652–1657 (April 2005)
Alterovitz, R., Lim, A., Goldberg, K., Chirikjian, G.S., Okamura, A.M.: Steering flexible needles under Markov motion uncertainty. In: Proc. IEEE/RSJ Int. Conf. on Intelligent Robots and Systems, pp. 120–125 (August 2005)
Alterovitz, R., Pouliot, J., Taschereau, R., Hsu, I.-C., Goldberg, K.: Needle insertion and radioactive seed implantation in human tissues: Simulation and sensitivity analysis. In: Proc. IEEE Int. Conf. on Robotics and Automation, vol. 2, pp. 1793–1799 (September 2003)
Alterovitz, R., Pouliot, J., Taschereau, R., Hsu, I.-C., Goldberg, K.: Sensorless planning for medical needle insertion procedures. In: Proc. IEEE/RSJ Int. Conf. on Intelligent Robots and Systems, vol. 3, pp. 3337–3343 (October 2003)
Bertsekas, D.P.: Dynamic Programming and Optimal Control, 2nd edn. Athena Scientific, Belmont (2000)
Bicchi, A., Casalino, G., Santilli, C.: Planning shortest bounded-curvature paths for a class of nonholonomic vehicles among obstacles. In: Proc. IEEE Int. Conf. on Robotics and Automation, pp. 1349–1354 (1995)
Chinzei, K., Hata, N., Jolesz, F.A., Kikinis, R.: MR compatible surgical assist robot: System integration and preliminary feasibility study. In: Medical Image Computing and Computer Assisted Intervention, pp. 921–930 (October 2000)
Choset, H., Lynch, K.M., Hutchinson, S., Kantor, G., Burgard, W., Kavraki, L.E., Thrun, S.: Principles of Robot Motion: Theory, Algorithms, and Implementations. MIT Press, Cambridge (2005)
Cleary, K., Ibanez, L., Navab, N., Stoianovici, D., Patriciu, A., Corral, G.: Segmentation of surgical needles for fluoroscopy servoing using the insight software toolkit (itk). In: Proc. Int. Conf. of the IEEE Engineering In Medicine and Biology Society, pp. 698–701 (2003)
DiMaio, S.P., Kacher, D.F., Ellis, R.E., Fichtinger, G., Hata, N., Zientara, G.P., Panych, L.P., Kikinis, R., Jolesz, F.A.: Needle artifact localization in 3T MR images. In: Westwood, J.D., et al. (eds.) Medicine Meets Virtual Reality 14, pp. 120–125. IOS Press, Amsterdam (2006)
DiMaio, S.P., Pieper, S., Chinzei, K., Hata, N., Balogh, E., Fichtinger, G., Tempany, C.M., Kikinis, R.: Robot-assisted needle placement in open-MRI: System architecture, integration and validation. In: Westwood, J.D., et al. (eds.) Medicine Meets Virtual Reality 14, Long Beach, CA, pp. 126–131. IOS Press, Amsterdam (2006)
DiMaio, S.P., Salcudean, S.E.: Needle steering and model-based trajectory planning. In: Medical Image Computing and Computer Assisted Intervention, pp. 33–40 (2003)
Dubins, L.: On curves of minimal length with a constraint on average curvature and with prescribed initial and terminal positions and tangents. American J. of Mathematics 79, 497–516 (1957)
Fichtinger, G., DeWeese, T.L., Patriciu, A., Tanacs, A., Mazilu, D., Anderson, J.H., Masamune, K., Taylor, R.H., Stoianovici, D.: System for robotically assisted prostate biopsy and therapy with intraoperative CT guidance. Academic Radiology 9(1), 60–74 (2002)
Glozman, D., Shoham, M.: Flexible needle steering and optimal trajectory planning for percutaneous therapies. In: Medical Image Computing and Computer Assisted Intervention (September 2004)
Jacobs, P., Canny, J.: Planning smooth paths for mobile robots. In: Proc. IEEE Int. Conf. on Robotics and Automation, pp. 2–7 (May 1989)
Kreke, J., Schaefer, A.J., Roberts, M., Bailey, M.: Optimizing testing and discharge decisions in the management of severe sepsis. In: Annual Meeting of INFORMS (November 2005)
Latombe, J.-C.: Robot Motion Planning. Kluwer Academic Pub., Dordrecht (1991)
Latombe, J.-C.: Motion planning: A journey of robots, molecules, digital actors, and other artifacts. Int. J. of Robotics Research 18(11), 1119–1128 (1999)
Laumond, J.-P., Jacobs, P.E., Taïx, M., Murray, R.M.: A motion planner for nonholonomic mobile robots. IEEE Trans. on Robotics and Automation 10(5), 577–593 (1994)
LaValle, S.M.: Planning Algorithms. Cambridge University Press, Cambridge (2006)
Masamune, K., Ji, L., Suzuki, M., Dohi, T., Iseki, H., Takakura, K.: A newly developed stereotactic robot with detachable drive for neurosurgery. In: Medical Image Computing and Computer Assisted Intervention (1998)
Park, W., Kim, J.S., Zhou, Y., Cowan, N.J., Okamura, A.M., Chirikjian, G.S.: Diffusion-based motion planning for a nonholonomic flexible needle model. In: Proc. IEEE Int. Conf. on Robotics and Automation, pp. 4611–4616 (April 2005)
Schneider, C., Okamura, A.M., Fichtinger, G.: A robotic system for transrectal needle insertion into the prostate with integrated ultrasound. In: Proc. IEEE Int. Conf. on Robotics and Automation, pp. 2085–2091 (May 2004)
Sellen, J.: Approximation and decision algorithms for curvature-constrained path planning: A state-space approach. In: Agarwal, P.K., Kavraki, L.E., Mason, M.T. (eds.) Workshop on the Algorithmic Foundations of Robotics, pp. 59–67. AK Peters, Ltd., Houston (1998)
Shechter, S., Schaefer, A.J., Braithwaite, S., Roberts, M., Bailey, M.: The optimal time to initiate HIV therapy. In: Annual Meeting of INFORMS (November 2005)
Taylor, R.H., Stoianovici, D.: Medical robotics in computer-integrated surgery. IEEE Trans. on Robotics and Automation 19(5), 765–781 (2003)
Webster III, R.J., Cowan, N.J., Chirikjian, G., Okamura, A.M.: Nonholonomic modeling of needle steering. In: Proc. 9th Int. Symp. on Experimental Robotics (June 2004)
Webster III, R.J., Memisevic, J., Okamura, A.M.: Design considerations for robotic needle steering. In: Proc. IEEE Int. Conf. on Robotics and Automation, pp. 3599–3605 (April 2005)
Author information
Authors and Affiliations
Editor information
Rights and permissions
Copyright information
© 2008 Springer-Verlag Berlin Heidelberg
About this chapter
Cite this chapter
Alterovitz, R., Branicky, M., Goldberg, K. (2008). Constant-Curvature Motion Planning Under Uncertainty with Applications in Image-Guided Medical Needle Steering. In: Akella, S., Amato, N.M., Huang, W.H., Mishra, B. (eds) Algorithmic Foundation of Robotics VII. Springer Tracts in Advanced Robotics, vol 47. Springer, Berlin, Heidelberg. https://doi.org/10.1007/978-3-540-68405-3_20
Download citation
DOI: https://doi.org/10.1007/978-3-540-68405-3_20
Publisher Name: Springer, Berlin, Heidelberg
Print ISBN: 978-3-540-68404-6
Online ISBN: 978-3-540-68405-3
eBook Packages: EngineeringEngineering (R0)