A safe and efficient decision algorithm for ramp merging based on a hierarchical planner and model predictive control

Abstract

Due to highly dynamic interactions between vehicles, ramp merging decision is extraordinarily challenging in dense traffic. To deal with the non-convexity and inter-coupling of the decision-making problem, a top-level behavioural planner is proposed, which considers both the overall traffic situation and the individual characteristics of other interacting drivers. To ensure the implementability and efficiency of planning, a bottom-level motion planner is further designed with the guide of the top-level behavioural planner. The validation simulation using a naturalistic driving dataset shows that the proposed planning algorithm can achieve a success rate of 97.65% and has similar gap selection decision as human drivers. Then to track the planned vehicle motion, a nonlinear model predictive controller considering actuator delay and lag characteristics is proposed. Finally, the proposed planning and control modules are deployed in a turbocharged test vehicle, with satisfactory vehicle lateral and speed tracking errors, which validate the implementability of the proposed ramp merging decision algorithms.