A Cooperative Longitudinal-Lateral Platoon Control Framework with Dynamic Lane Management for Unmanned Ground Vehicles Based on a Dual-Stage Multi-Objective MPC Approach

Cooperative longitudinal–lateral trajectory optimization is essential for unmanned ground vehicle (UGV) platoons to improve safety, capacity, and efficiency. However, existing approaches often face unstable formation under low penetration rates and rely on fragmented control strategies. This study develops a cooperative longitudinal–lateral trajectory tracking framework tailored for UGV platooning, embedded in a hierarchical control architecture. Dual-stage multi-objective Model Predictive Control (MPC) is proposed, decomposing trajectory planning into pursuit and platooning phases. Each stage employs adaptive weighting to balance platoon efficiency and traffic performance across varying operating conditions. Furthermore, a traffic-aware organizational module is designed to enable the dynamic opening of UGV-dedicated lanes, ensuring that platoon formation remains compatible with overall traffic flow. Simulation results demonstrate that the adaptive weighting strategy reduces the platoon formation time by 41.6% with only a 1.29% reduction in the average traffic speed. In addition, the dynamic lane management mechanism yields longer and more stable UGV platoons under different penetration levels, particularly in high-flow environments. The proposed cooperative framework provides a scalable solution for advancing UGV platoon control and demonstrates the potential of unmanned systems in future intelligent transportation applications.