Optimal Trajectory Planning for Autonomous Driving Integrating Logical Constraints: An MIQP Perspective

Xiangjun Qian (1) , Florent Altché (1) , Philipp Bender (2) , Christoph Stiller (2) , Arnaud de La Fortelle (1)

1 CAOR - Centre de Robotique
2 KIT - Karlsruhe Institute of Technology

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 effectively 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.

Domaines: Robotique [cs.RO]

Xiangjun Qian, Florent Altché, Philipp Bender, Christoph Stiller, Arnaud de La Fortelle. Optimal Trajectory Planning for Autonomous Driving Integrating Logical Constraints: An MIQP Perspective. 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC 2016), Nov 2016, Rio de Janeiro, Brazil. ⟨hal-01342358v2⟩