Optimal trajectory planning for autonomous driving integrating logical constraints: An MIQP perspective
Authors:
- 26 December 2016
- conference paper
- Published by Institute of Electrical and Electronics Engineers (IEEE)
- p. 205-210
Abstract
This paper considers the problem of optimal trajectory generation for autonomous driving under both continuous and logical constraints. Classical approaches based on continuous optimization formulate the trajectory generation problem as a nonlinear program, in which vehicle dynamics and obstacle avoidance requirements are enforced as nonlinear equality and inequality constraints. In general, gradient-based optimization methods are then used to find the optimal trajectory. However, these methods are ill-suited for logical constraints such as those raised by traffic rules, presence of obstacles and, more generally, to the existence of multiple maneuver variants. We propose a new formulation of the trajectory planning problem as a Mixed-Integer Quadratic Program. This formulation can be solved efficiently using widely available solvers, and the resulting trajectory is guaranteed to be globally optimal. We apply our framework to several scenarios that are still widely considered as challenging for autonomous driving, such as obstacle avoidance with multiple maneuver choices, overtaking with oncoming traffic or optimal lane-change decision making. Simulation results demonstrate the effectiveness of our approach and its real-time applicability.Keywords
This publication has 13 references indexed in Scilit:
- Receding horizon maneuver generation for automated highway drivingControl Engineering Practice, 2015
- Predictive ADAS: A predictive trajectory guidance scheme for advanced driver assistance in public traffic2015
- The combinatorial aspect of motion planning: Maneuver variants in structured environments2015
- Autonomous lane-change controller via mixed logical dynamical2014
- Trajectory planning for Bertha — A local, continuous method2014
- Strategic decision making for automated driving on two-lane, one way roads using model predictive control2013
- Optimal trajectories for time-critical street scenarios using discretized terminal manifoldsThe International Journal of Robotics Research, 2011
- Team AnnieWAY's autonomous system for the 2007 DARPA Urban ChallengeJournal of Field Robotics, 2008
- MPC-based approach to active steering for autonomous vehicle systemsInternational Journal of Vehicle Autonomous Systems, 2005
- Receding horizon control of autonomous aerial vehicles2002