Dynamic Trajectory Planning and Tracking for Autonomous Vehicle with Obstacle Avoidance Based on Model Predictive Control

Abstract

In this study, an obstacle avoidance controller based on nonlinear model predictive control is designed in autonomous vehicle navigation. The reference trajectory is predefined using a sigmoid function in accordance with road conditions. When obstacles suddenly appear on a predefined trajectory, the reference trajectory should be adjusted dynamically. For dynamic obstacles, a moving trend function is constructed to predict the obstacle position variances in the predictive horizon. Furthermore, a risk index is constructed and introduced into the cost function to realize collision avoidance by combining the relative position relationship between vehicle and obstacles in the predictive horizon. Meanwhile, lateral acceleration constraint is also considered to ensure vehicle stability. Finally, trajectory dynamic planning and tracking are integrated into a single-level model predictive controller. Simulation tests reveal that the designed controller can ensure real-time trajectory tracking and collision avoidance.