Search papers, labs, and topics across Lattice.
This paper introduces a sequential path planning framework that integrates graph search with Model Predictive Control (MPC) to enhance the efficiency and smoothness of path planning for autonomous vehicles. By utilizing a rough path generated from Dijkstra's algorithm to create a convex lateral safety corridor, the method transforms discrete obstacle avoidance into continuous optimization constraints, allowing for refined path adjustments. The approach significantly outperforms previous methods, achieving lower lateral acceleration and jerk while reducing computational costs by over 28% in various driving scenarios.
Integrating graph search with MPC can cut computational costs by nearly 30% while ensuring smoother paths for autonomous vehicles.
Path planning is a fundamental component of autonomous vehicles, where achieving safe, comfortable, and dynamically feasible paths while ensuring computational efficiency remains a significant challenge. This paper presents a sequential path planning framework in which a rough path obtained from graph search is explicitly exploited to guide a Model Predictive Control (MPC)-based path refinement. A rough path is first obtained via Dijkstra search on a discretized grid and is then used to construct a spatially varying convex lateral safety corridor that explicitly captures obstacle avoidance constraints, transforming discrete obstacle avoidance decisions into continuous feasibility constraints for optimization. Within this corridor, an MPC problem is formulated to refine the path, enabling efficient optimization while maintaining path smoothness by penalizing the third-order spatial derivative of the lateral offset over a prediction horizon. The proposed algorithm is evaluated in multiple overtaking scenarios on both straight and curved roads, including cases with single and multiple target vehicles, using high-fidelity environment simulations (i.e., CarMaker). Compared with the previous study, which used polynomial fitting and a quadratic programming method, the proposed approach consistently achieves lower lateral acceleration, curvature, and jerk while reducing computational cost by 28.08% on straight roads and 29.52% on curved roads. These results demonstrate that exploiting graph-search structure within an MPC formulation provides an effective balance between path smoothness and computational efficiency for autonomous vehicles in structured driving environments.
