Sequential Convex Programming Methods for Real-time Trajectory Optimization in Autonomous Racing

Paper (not published yet)

Watch Full Video on YouTube

Explore on GitHub

Abstract

We present a real-time-capable Model Predictive Controller based on a single-track vehicle model and Pacejka’s magic tire formula for autonomous racing applications. After constructing a non-convex trajectory optimization problem, it is convexified using the Sequential Convex Programming method. We use two different methods for track discretization, namely Sequential Linearization (SL) and Sequential Convex Restriction (SCR). SL was already introduced in our previous paper. SCR is a new addition, introduced in detail and its recursive feasibility proven. We show that a controller with SCR yields faster lap times - for race starts as well as flying laps - while being real-time capable.

Instructions

0. clone or download this repo and open MATLAB in this folder
1. open folder 'code' via cd code in MATLAB
2. optional: choose a pre-configured scenario in file 'run.m' Alternatively, configure an individual configuration as described in the next paragraph
3. run the scenario via run()

Configuration

In the folder 'code/+config', all configruations of scenarios and vehicles are stored. You can combine the building blocks to your likes or even create a completly new configuration

Requirements

• MATLAB
  • Version: recommended R2021a, minimum R2019a
  • Symbolic Math Toolbox
  • Statistics and Machine Learning Toolbox (required for evaluation only)
• Solver
  • recommended IBM ILOG CPLEX Optimization Studio 12.10
  • alternatively, MATLAB's 'quadprog' via 'Symbolic Math Toolbox'

tested on UNIX (Ubuntu 18.04 64-bit) and Windows 10 64-bit, MATLAB R2021a, R2019b, R2019a

Miscellaneous

• export large figures: print('-painters', gcf, "filename.svg", '-dsvg')

TODOs

• also search for 'FIXME' for issues to be fixed
• use 'sim scale' to norm all other scales
  • regularize states and inputs and their respective weights, scale models and track --> allows easy adaption to miniature and full-sized vehicle
  • scale vehicle size (length/width) for correct vehicle avoidance
• for usage of differing models for simulation/controller: improve acceleration controller (linear model inputs --> simulation inputs)
• geometrical vehicle scaling is missing: values hard-coded in 'vehicle' config, better should be part of vehicle model parameters
• smoke tests by running all scenarios automatically
• track models should give available start positions & max number of vehicles
• add acceleration limits to plot for linear model