Summary
We describe a practical path-planning algorithm that generates smooth paths for an autonomous vehicle operating in an unknown environment, where obstacles are detected online by the robot’s sensors. This work was motivated by and experimentally validated in the 2007 DARPA Urban Challenge, where robotic vehicles had to autonomously navigate parking lots. Our approach has two main steps. The first step uses a variant of the well-known A* search algorithm, applied to the 3D kinematic state space of the vehicle, but with a modified state-update rule that captures the continuous state of the vehicle in the discrete nodes of A* (thus guaranteeing kinematic feasibility of the path). The second step then improves the quality of the solution via numeric non-linear optimization, leading to a local (and frequently global) optimum. The path-planning algorithm described in this paper was used by the Stanford Racing Teams robot, Junior, in the Urban Challenge. Junior demonstrated flawless performance in complex general path-planning tasks such as navigating parking lots and executing U-turns on blocked roads. In typical real parking lots—significantly more complex than the ones in the DARPA Urban Challenge—the time of a full re-planning cycle is on the order of 50–300ms.
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
Andrews, J., Hogan, N.: Impedance control as a framework for implementing obstacle avoidance in a manipulator. In: Control of Manufacturing Proc. and Robotic Sys. (1983)
Choset, H., Burdick, J.: Sensor-based exploration: The hierarchical generalized voronoi graph. The International Journal of Robotics Research 19 (2000)
Connolly, C., Burns, J., Weiss, R.: Path planning using Laplace’s equation. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 2102–2106 (1990)
Cremean, L.B., Foote, T.B., Gillula, J.H., Hines, G.H., Kogan, D., Kriechbaum, K.L., Lamb, J.C., Leibs, J., Lindzey, L., Rasmussen, C.E., Stewart, A.D., Burdick, J.W., Murray, R.M.: Alice: An information-rich autonomous vehicle for high-speed desert navigation. Journal of Field Robotics (2006)
DARPA. Darpa. urban challenge rules (revision october 27, 2007) (2007), www.darpa.mil/grandchallenge/rules.asp
Ersson, T., Hu, X.: Path planning and navigation of mobile robots in unknown environments. In: IEEE International Conf. on Intelligent Robots and Systems (IROS) (2001)
Ferguson, D., Stentz, A.: Field d*: An interpolation-based path planner and replanner. In: Proceedings of the Int. Symp. on Robotics Research (ISRR) (October 2005)
Kavraki, L., Svestka, P., Latombe, J.-C., Overmars, M.: Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Transactions on Robotics and Automation 12(4) (1996)
Khatib, O.: Real-time obstacle avoidance for manipulators and mobile robots. International Journal of Robotics Research 5(1), 90–98 (1986)
Koditschek, D.E.: Exact robot navigation by means of potential functions: Some topological considerations. In: IEEE Int. Conf. on Robotics and Autom. (March 1987)
Koenig, S., Likhachev, M.: Improved fast replanning for robot navigation in unknown terrain. In: IEEE Int. Conf. on Robotics and Automation (ICRA) (2002)
Koren, Y., Borenstein, J.: Potential field methods and their inherent limitations for mobile robot navigation. In: ICRA (1991)
LaValle, S.: Rapidly-exploring random trees: A new tool for path planning (1998)
Miyazaki, F., Arimoto, S.: Sensory feedback for robot manipulators. Journal of Robotic Systems 2(1), 53–71 (1985)
Nash, A., Daniel, K., Koenig, S., Felner, A.: Theta*: Any-angle path planning on grids. In: Proceedings of the AAAI Conference on Artificial Intelligence (AAAI), pp. 1177–1183. AAAI Press, Menlo Park (2007)
Pavlov, V., Voronin, A.N.: The method of potential functions for coding constraints of the external space in an intelligent mobile robot. Soviet Automatic Control 17(6) (1984)
Plaku, E., Kavraki, L., Vardi, M.: Discrete search leading continuous exploration for kinodynamic motion planning. In: Robotics: Science and Systems (June 2007)
Rimon, E., Koditschek, D.E.: Exact robot navigation using artificial potential fields. IEEE Transactions on Robotics and Automation 8(5), 501–518 (1992)
Tilove, R.: Robotics and automation. In: IEEE International Conference on Robotics and Automation, vol. 1, pp. 566–571 (1990)
Author information
Authors and Affiliations
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2009 Springer-Verlag Berlin Heidelberg
About this paper
Cite this paper
Dolgov, D., Thrun, S., Montemerlo, M., Diebel, J. (2009). Path Planning for Autonomous Driving in Unknown Environments. In: Khatib, O., Kumar, V., Pappas, G.J. (eds) Experimental Robotics. Springer Tracts in Advanced Robotics, vol 54. Springer, Berlin, Heidelberg. https://doi.org/10.1007/978-3-642-00196-3_8
Download citation
DOI: https://doi.org/10.1007/978-3-642-00196-3_8
Publisher Name: Springer, Berlin, Heidelberg
Print ISBN: 978-3-642-00195-6
Online ISBN: 978-3-642-00196-3
eBook Packages: EngineeringEngineering (R0)