Multi-Vehicle Collaborative Trajectory Planning Based on Kaldor-Hicks Improvement
Donglei Rong, Wenbin Yao, Chengcheng Yang, Congcong Bai, Sheng Jin · IEEE Transactions on Automation Science and Engineering · 2025
This paper employs lateral and longitudinal trajectory planning to generate candidate trajectories and discards those that do not satisfy the constraints imposed by single-vehicle conditions. Next, a collaborative trajectory combination set for multiple vehicles is derived from the candidate trajectories, with multi-vehicle constraints applied to eliminate combinations that fail to meet the required conditions. The objective function for each candidate trajectory set is first calculated using a single-vehicle objective function, after which a multi-vehicle objective function based on the Kaldor-Hicks improvement principle is constructed. Finally, the paper introduces an improved particle swarm optimization method for multi-vehicle collaborative trajectory planning. The results demonstrate that the dynamic spatiotemporal occupancy growth rate, under varying planning times and frequencies, is at least 19%. Furthermore, the proposed algorithm ensures efficient allocation of travel resources, preventing competition among vehicles that could compromise system feasibility. When verified with HighD trajectory data, the algorithm not only delivers superior optimization results but also exhibits lower standard deviations in dynamic spatiotemporal occupancy and speed compared to real-world data. Finally, the algorithm’s superiority in real-time decision-making and stability is confirmed. Note to Practitioners—In the context of mixed traffic comprising both autonomous and human-driven vehicles, this paper tackles the challenge of coordinating autonomous vehicles to improve traffic efficiency and safety in real-time environments. It presents a promising approach to enhancing cooperative behavior in complex scenarios by integrating real-time data streams to optimize adaptability and ensure equitable driving efficiency across different vehicle types.