Improved MPC for trajectory planning of self-driving cars

To tackle the challenges associated with lane changes in diverse driving environments, this study introduces an Improved Model Predictive Control (IMPC) approach that integrates vehicle state and driving context to execute maneuvers effectively. Initially, a simplified model is established, incorporating vehicle position, velocity, and driving conditions. Subsequently, a Sigmoid function is utilized to restrict vehicle movements, while Finite State Machine (FSM) decision-making selects appropriate maneuvers in real time according to changing driving conditions. In addition, a discrete Simplified Dual Neural Network (SDNN) is utilized to efficiently solve Quadratic Programming (QP) problems, overcoming the slow-solving issue of traditional MPC and ensuring rapid acquisition of longitudinal and lateral accelerations for lane changes, braking, and overtaking maneuvers. Finally, the results from hardware-in-the-loop (HIL) simulation validation indicate that IMPC can efficiently address collision avoidance with surrounding dynamic vehicles across three distinct driving scenarios.