arXiv:2607.04259cs.RO2026-07

用图搜索引导模型预测控制,实现高效平滑的自动驾驶路径规划

Integrated Graph Search and Model Predictive Control for Smooth and Efficient Path Planning in Autonomous Vehicles

论文配图:Integrated Graph Search and Model Predictive Control for Smooth and Efficient Path Planning in Autonomous Vehicles
图 1 · 摘自论文原文
  • 先用Dijkstra获取粗路径,再构建可变安全走廊约束优化
  • 相比传统方法,横向加速度、曲率和急动度均降低,计算成本减少超28%
  • 适合需要平滑路径与实时计算的自动驾驶系统研发

路径规划是自动驾驶的核心环节,如何在保证安全、舒适和动态可行性的同时实现高效计算仍是挑战。本文提出一种分步路径规划框架:先通过离散网格上的Dijkstra算法获得粗略路径,并以此构建随空间变化的凸横向安全走廊,将离散避障决策转化为连续优化约束;在此走廊内,基于模型预测控制(MPC)对路径进行精细化调整,通过惩罚预测时域内横向偏移的三阶导数来保持路径平滑性。该方法在CarMaker高保真仿真环境中,针对直道与弯道上的单/多目标车辆超车场景进行了验证。相较于此前采用多项式拟合与二次规划的方法,本方案在直道上计算成本降低28.08%,弯道降低29.52%,且横向加速度、曲率和急动度均更低,充分证明了在结构化道路环境中利用图搜索结构指导MPC能有效平衡路径平滑性与计算效率。

原文摘要 · Abstract (English)

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.

路径规划MPC自动驾驶图搜索

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。