Search papers, labs, and topics across Lattice.
This paper introduces Branch-Stochastic Model Predictive Control (BSMPC), a motion planning algorithm that combines SMPC with a branching structure to handle multi-modal intention uncertainty in autonomous driving. The key idea is to generate distinct trajectories conditioned on different possible intentions of surrounding vehicles, while maintaining safety under trajectory uncertainty via chance constraints. A novel scenario clustering method merges prediction scenarios based on decision similarity to ensure real-time performance, and adaptive branching postpones plan commitment.
Autonomous vehicles can now navigate complex, uncertain traffic scenarios more safely and less conservatively by branching their plans based on other drivers' likely intentions.
Motion planning for autonomous driving must account for multi-modal uncertainty in both the intentions and trajectories of surrounding vehicles. Handling uncertainty in a worst-case manner guarantees robustness but often leads to excessive conservatism. Stochastic Model Predictive Control (SMPC) reduces trajectory-level conservatism through chance constraints, yet remains conservative with respect to intention uncertainty since constraints must hold across all intentions. We present a novel combination of SMPC and the branching structure, enabling the planner to generate distinct trajectories for different possible intentions while maintaining safety under trajectory uncertainty. A novel scenario clustering is proposed to merge prediction scenarios based on high-level decision similarity, thereby ensuring real-time tractability. Furthermore, an adaptive branching-time computation postpones commitment to separate plans until intention uncertainty is sufficiently reduced. Simulation studies in challenging highway scenarios demonstrate that the proposed method improves safety, reduces conservatism, and achieves real-time computational performance.