Model Predictive Control for Lane Merging Automation with Recursive Feasibility Guarantees

Abstract

In order to make the complex driving task of merging safer, in this paper we consider the automated merging of an autonomous vehicle into a mixed-traffic flow scenario (i.e., traffic including autonomous and manually driven vehicles). In particular, we propose a novel MPC-based algorithm to perform a merging procedure from a double lane into a single lane and continue with (adaptive) cruise control ((A)CC) functionality after the merge. The proposed MPC balances fast progress along the path with comfort, while obeying safety and maximum allowed velocity bounds. Recursive feasibility, leading to safety and proper behavior, is guaranteed by the design of a proper terminal set, extending existing ones in the literature. The on-line MPC problem is translated into a mixed integer quadratic program (MIQP) that can be solved for global optimality. Through numerical simulations we demonstrate the behavior and effectiveness of the proposed MPC merging scheme.