Mixed-integer optimization-based planning for autonomous racing with obstacles and rewards

Abstract Trajectory planning with the consideration of obstacles is a classical task in autonomous driving and robotics applications. This paper introduces a novel solution approach for the subclass of autonomous racing problems which is additionally capable of dealing with reward objects. This special type of objects is representing particular regions in state space, whose optional reaching is somehow beneficial (e.g. results in bonus points during a race). First, a homotopy class is selected which represents the left/right and catch/ignore decisions related to obstacle avoidance and reward collection, respectively. For this purpose, a linear mixed-integer problem is posed such that an approximated combinatorial problem is solved and repetitive switching decisions between solver calls are avoided. Secondly, an optimal control problem (OCP) based on a single-track vehicle model is solved within this homotopy class. In the corresponding nonlinear program, homotopy iterations are performed on the race track boundaries which correspond to the previously chosen homotopy class. This leads to an improved convergence of the solver compared to the direct approach. The mixed-integer method’s effectiveness is demonstrated within a real-world test scenario during the autonomous racing competition Roborace. Furthermore, its combination with the OCP as well as the performance gain resulting from the homotopy iterations are shown in simulation.

[1]  Moritz Diehl,et al.  Towards a modular software package for embedded optimization , 2018 .

[2]  J. Christian Gerdes,et al.  A Sequential Two-Step Algorithm for Fast Generation of Vehicle Racing Trajectories , 2015, ArXiv.

[3]  Jonathan P. How,et al.  Spacecraft trajectory planning with avoidance constraints using mixed-integer linear programming , 2002 .

[4]  B. Moor,et al.  Mixed integer programming for multi-vehicle path planning , 2001, 2001 European Control Conference (ECC).

[5]  Markus Lienkamp,et al.  Minimum curvature trajectory planning and control for an autonomous race car , 2020, Vehicle System Dynamics.

[6]  Vicenç Puig,et al.  LPV-MP planning for autonomous racing vehicles considering obstacles , 2020, Robotics Auton. Syst..

[7]  Luigi Palopoli,et al.  Global path planning for competitive robotic cars , 2013, 52nd IEEE Conference on Decision and Control.

[8]  Manfred Morari,et al.  Optimization‐based autonomous racing of 1:43 scale RC cars , 2015, ArXiv.

[9]  M. Diehl,et al.  HPIPM: a high-performance quadratic programming framework for model predictive control , 2020, IFAC-PapersOnLine.

[10]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[11]  J. Christian Gerdes,et al.  Autonomous vehicle control for emergency maneuvers: The effect of topography , 2015, 2015 American Control Conference (ACC).

[12]  Karl Iagnemma,et al.  Homotopy-Based Divide-and-Conquer Strategy for Optimal Trajectory Planning via Mixed-Integer Programming , 2015, IEEE Transactions on Robotics.

[13]  Francesco Braghin,et al.  Race driver model , 2008 .

[14]  M. Diehl,et al.  NMPC for Racing Using a Singularity-Free Path-Parametric Model with Obstacle Avoidance , 2020, IFAC-PapersOnLine.

[15]  Daniel Axehill,et al.  Combining Homotopy Methods and Numerical Optimal Control to Solve Motion Planning Problems , 2017, 2018 IEEE Intelligent Vehicles Symposium (IV).

[16]  Michal Kvasnica,et al.  OPTIPLAN: A Matlab Toolbox for Model Predictive Control with Obstacle Avoidance , 2017 .

[17]  Daniel Axehill,et al.  Improved Path Planning by Tightly Combining Lattice-Based Path Planning and Optimal Control , 2021, IEEE Transactions on Intelligent Vehicles.