A practical trajectory planning framework for autonomous ground vehicles driving in urban environments
Authors:
- 1 June 2015
- conference paper
- Published by Institute of Electrical and Electronics Engineers (IEEE)
- No. 19310587,p. 1160-1166
Abstract
This paper presents a practical trajectory planning framework towards fully autonomous driving in urban environments. Firstly, based on the behavioral decision commands, a reference path is extracted from the digital map using the LIDAR-based localization information. The reference path is refined and interpolated via a nonlinear optimization algorithm and a parametric algorithm, respectively. Secondly, the trajectory planning task is decomposed into spatial path planning and velocity profile planning. A closed-form algorithm is employed to generate a rich set of kinematically-feasible spatial path candidates within the curvilinear coordinate framework. At the same time, the velocity planning algorithm is performed with considering safety and smoothness constraints. The trajectory candidates are evaluated by a carefully developed objective function. Subsequently, the best collision-free and dynamically-feasible trajectory is selected and executed by the trajectory tracking controller. We implemented the proposed trajectory planning strategy on our test autonomous vehicle in the realistic urban traffic scenarios. Experimental results demonstrated its capability and efficiency to handle a variety of driving situations, such as lane keeping, lane changing, vehicle following, and static and dynamic obstacles avoiding, while respecting traffic regulations.Keywords
This publication has 19 references indexed in Scilit:
- Combining local trajectory planning and tracking control for autonomous ground vehicles navigating along a reference path2014
- Video based localization for Bertha2014
- A sampling-based local trajectory planner for autonomous driving along a reference path2014
- A sampling-based partial motion planning framework for system-compliant navigation along a reference path2013
- Focused Trajectory Planning for autonomous on-road driving2013
- Towards fully autonomous driving: Systems and algorithms2011
- Motion planning for autonomous driving with a conformal spatiotemporal lattice2011
- Junior: The Stanford entry in the Urban ChallengeJournal of Field Robotics, 2008
- Optimal Rough Terrain Trajectory Generation for Wheeled Mobile RobotsThe International Journal of Robotics Research, 2007
- Stanley: The robot that won the DARPA Grand ChallengeJournal of Field Robotics, 2006