Guaranteeing safety in motion planning is a crucial bottleneck on the path towards wider adoption of autonomous driving technology. A promising direction is to pose safety requirements as planning constraints in nonlinear optimization problems of motion synthesis. However, many implementations of this approach are hindered by uncertain convergence and local optimality of the solutions, affecting the planner’s overall robustness. In this paper, we propose a novel two-stage optimization framework: we first find the solution to a Mixed-Integer Linear Programming (MILP) approximation of the motion synthesis problem, which in turn initializes a second Nonlinear Programming (NLP) formulation. We show that initializing the NLP stage with the MILP solution leads to better convergence, lower costs, and outperforms a state-of-the-art Nonlinear Model Predictive Control baseline in both progress and comfort metrics.
|Number of pages||3|
|Publication status||E-pub ahead of print - 13 Jul 2020|
|Event||Second (virtual) workshop on Robust autonomy: Safe robot learning and control in uncertain real-world environments - |
Duration: 13 Jul 2020 → 13 Jul 2020
|Workshop||Second (virtual) workshop on Robust autonomy|
|Period||13/07/20 → 13/07/20|