arXiv:2605.14199cs.ROcs.SY2026-05

用凸集图优化方法,高效生成自动驾驶的避障动态轨迹。

Motion Planning for Autonomous Vehicles using Optimization over Graphs of Convex Sets

论文配图:Motion Planning for Autonomous Vehicles using Optimization over Graphs of Convex Sets
图 1 · 摘自论文原文
  • 将环境划分为凸区域并建图,通过离散连接决策处理非凸几何。
  • 轨迹用贝塞尔曲线与多项式时序函数参数化,动态可行性由凸约束保证。
  • 相比非线性规划更高效且对初始值不敏感,适合实时自动驾驶系统。

自动驾驶车辆的运动规划需在复杂环境中生成无碰撞且动力学可行的轨迹,同时满足实时性要求。尽管非线性最优控制能提供高保真解,但计算量大且对初始值敏感;而几何规划方法虽可扩展性强,却常将路径选择与轨迹优化分离。本文研究了基于凸集图(Graphs of Convex Sets, GCS)的优化方法,在自动驾驶场景中近似非线性最优控制问题的能力。将自由空间表示为有限个凸区域构成的有向图,通过离散连通性决策处理非凸几何,同时在每个区域内保持轨迹的凸性约束。车辆运动采用贝塞尔曲线表示空间路径,多项式时间缩放函数描述时间演化。在小滑移和线性轮胎假设下,简化后的动力学自行车模型可通过轨迹导数的凸约束近似实现动力学可行性。该方法在CommonRoad基准场景中评估,涵盖静态障碍物避让和变道操作,并与非线性离散时间最优控制方法对比。结果表明,GCS方法生成的轨迹既无碰撞又符合动力学一致性,与非线性规划解高度接近,同时具备更高的计算效率和更低的初始化敏感性。这些发现表明,GCS为非线性运动规划问题提供了结构化的近似,有效捕捉主要几何与动力学效应,且保持连续松弛下的凸性。

原文摘要 · Abstract (English)

Motion planning for autonomous vehicles requires generating collision-free and dynamically feasible trajectories in complex environments under real-time constraints. While nonlinear optimal control formulations provide high-fidelity solutions, they are computationally demanding and sensitive to initialization, whereas geometric planning methods scale well but often decouple path selection from trajectory optimization. This paper studies the extent to which optimization over Graphs of Convex Sets (GCS) can approximate solutions of nonlinear optimal control problems in the context of autonomous driving. The free space is represented as a finite union of convex regions organized as a directed graph, allowing nonconvex geometry to be handled through discrete connectivity decisions while maintaining convex trajectory constraints within each region. Vehicle motion is parameterized using Bezier curves for the spatial path and a polynomial time-scaling function for temporal evolution. Under small-slip and linear tire assumptions, a simplified dynamic bicycle model enables approximate enforcement of dynamic feasibility through convex constraints on trajectory derivatives. The approach is evaluated in CommonRoad scenarios involving static obstacle avoidance and lane-changing maneuvers, and is compared against a nonlinear discrete-time optimal control formulation. The results indicate that the GCS-based method generates collision-free and dynamically consistent trajectories that closely match those obtained from the nonlinear program, while exhibiting improved computational efficiency and reduced sensitivity to initialization. These findings suggest that GCS provides a structured approximation of nonlinear motion planning problems, capturing dominant geometric and dynamic effects while preserving convexity in the continuous relaxation.

运动规划凸优化自动驾驶轨迹生成

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