This paper presents a trajectory planning framework to deal with the highly dynamic environments for on-road driving. The trajectory optimization problem with parameterized curvature control was formulated to reach the goal state with the vehicle model and its dynamic constraints considered. This in contrast to existing curve fitting techniques guarantees the dynamic feasibility of the planned trajectory. With generation of multiple trajectory candidates along the Frenet frame, the vehicle is reactive to other road users or obstacles encountered. Additionally, to deal with more complex driving scenarios, its seamless interaction with an upper behavior planning layer was considered by having longitudinal motion planning responsive to the desired goal state. The trajectory evaluation and selection methodologies, along with the low-level tracking control, were also developed under this framework. The potential of the proposed trajectory planning framework was demonstrated under different dynamic driving scenarios such as lane-changing or merging with surrounding vehicles with its computation efficiency proven in real-time simulations.
Read full abstract