Nonlinear Model Predictive Control with Terminal Cost for Autonomous Vehicles Trajectory Follow

Abstract

This paper presents a nonlinear model predictive control with terminal cost (NMPC–WTC) algorithm and its open/closed-loop system analysis and simulation validation for accurate and stable path tracking of autonomous vehicles. The path tracking issue is formulated as an optimal control problem. In order to improve the squeezing phenomenon of traditional NMPC, a discrete-time nonlinear model predictive controller with terminal cost is then designed, in which the state error of last step is augmented. The cost function of NMPC–WTC consists of two parts: (1) the traditional NMPC cost function responding to tracking errors and controller output, and (2) the augmented terminal cost. The algorithm was implemented on CasADi numerical optimization framework, which is free, open-source and developed for nonlinear optimization. The open-loop and closed-loop simulation results are then presented to demonstrate the improved performance in tracking accuracy and stability compared to traditional model predictive controller.