Planning trajectories for connected and automated vehicle platoon on curved roads: A two-dimensional cooperative approach

Abstract

This paper presents a cooperative two-dimensional trajectory planning algorithm for connected and automated vehicle (CAV) platoons. Specifically, the proposed algorithm generates two-dimensional optimal trajectories for CAVs with car-following relationships cooperatively within a complex road geometry. By extending the simplified Newell’s car-following model, we propose a two-dimensional Newell’s car-following model as an equilibrium car-following policy for CAVs. Based on this, a multi-objective constrained optimization is systematically formulated under a Cartesian coordinate. Due to the constraint’s complexity, a new solving algorithm based on the rapid random tree (RRT) technique is proposed. To test the effectiveness of our proposed models and algorithm, numerical simulation experiments with a real-world road geometry are conducted. Results indicate that our proposed method is able to generate trajectories for CAV platoons which are close to the equilibrium condition with smooth controls, while avoiding road obstacles. We further extend the definition of a one-dimensional car-following control string stability to a two-dimensional case. By this definition, we find that the proposed method can achieve empirical two-dimensional string stability, ensuring that both lateral and longitudinal disturbances are attenuated through vehicular strings.