Obstacle Avoidance in Real Time With Nonlinear Model Predictive Control of Autonomous Vehicles

A Nonlinear model predictive control (NMPC) for trajectory tracking with the obstacle avoidance of autonomous road vehicles traveling at realistic speeds is presented in this paper, with a focus on the performance of those controllers with respect to the look-ahead horizon of the NMPC. Two different methods of obstacle avoidance are compared and then the NMPC is tested in several simulated but realistic tracking scenarios involving static obstacles on constrained roadways. In order to simplify the vehicle dynamics, a bicycle model is used for the prediction of future vehicle states in the NMPC framework. However, a high-fidelity, nonlinear CarSim vehicle model is used to evaluate the vehicle performance and test the controllers in the simulation results. The CPU time is also analyzed to evaluate these schemes for real-time applications. The results show that the NMPC controller provides satisfactory online tracking performance in a realistic scenario at normal road speeds while still satisfying the real-time constraints. In addition, it is shown that the longer prediction horizons allow for better responses of the controllers, which reduce the deviations while avoiding the obstacles, as compared with shorter horizons.