Autonomous Vehicle Control: A Nonconvex Approach for Obstacle Avoidance

This paper develops a two-stage nonlinear nonconvex control approach for autonomous vehicle driving during highway cruise conditions. The goal of the controller is to track the centerline of the roadway while avoiding obstacles. An outer-loop nonlinear model predictive control is adopted for generating the collision-free trajectory with the resultant input based on a simplified vehicle model. The optimization is solved through the generalized minimal residual method augmented with a continuation method. A sufficient condition to overcome limitations associated with continuation methods is introduced. The inner loop is a simple linear feedback controller based on an optimal preview distance. Simulation results illustrate the effectiveness of the approach. These are bolstered by scaled-vehicle experimental results.