arXiv:2606.14063cs.ROcs.SY2026-06

用半定规划求解无碰撞路径,理论严谨且速度超快。

Semidefinite Relaxations for Collision-Free Motion Planning

论文配图:Semidefinite Relaxations for Collision-Free Motion Planning
图 1 · 摘自论文原文
  • 将路径规划转为多项式曲线的非凸问题,再通过半定松弛求解。
  • 松弛后计算效率提升10到100倍,且解更稳定可靠。
  • 适合需要快速生成高阶连续轨迹的无人机等系统应用。

我们研究了用于无碰撞运动规划的半定松弛方法。考虑一个点机器人在R^n空间中从起点移动到终点,穿越球形障碍物,受路径连续性约束和平方导数代价限制,该设定虽概念简单,却体现了无碰撞路径规划的核心难点。我们将此问题精确建模为多项式曲线上的非凸优化问题,并提出一种自然的半定松弛方法。本文贡献了两个关键理论洞见:首先,证明求解该凸松弛等价于在可能更高维空间中全局最优求解一个相关运动规划问题,这一几何解释给出了紧性(tightness)的充要条件,清晰揭示了松弛松散的场景;其次,发现松弛可进行对称性降维,使得半正定锥规模仅随多项式次数线性增长,与环境维度无关。由此产生的松弛模型比直接使用SNOPT和IPOPT求解的非线性规划方法快10至100倍,求解时间方差显著降低,且能可靠找到原问题的局部最优路径。我们还验证其作为凸引导函数在RRT规划器中的有效性,实现了四阶连续轨迹的最小抖动四旋翼路径规划。

原文摘要 · Abstract (English)

We study semidefinite relaxations for collision-free motion planning. We focus on a point robot moving from start to goal through spherical obstacles in $\mathbb{R}^n$, subject to path continuity constraints and squared derivative costs; a setting that is conceptually simple yet captures the hardness of collision-free motion planning. We formulate this problem exactly as a nonconvex problem over polynomial curves, and present a natural semidefinite relaxation. We contribute two key theoretical insights; to our knowledge this is the first theoretical analysis of semidefinite relaxations for collision-free motion planning. First, we show that solving the convex relaxation is equivalent to solving, to global optimality, a related motion planning problem in a potentially higher-dimensional space. This geometric interpretation yields necessary and sufficient conditions for tightness, and a clear intuition for when the relaxation is loose. Second, we show that the relaxation admits a symmetry reduction that makes it significantly smaller than one might expect, with positive semidefinite cone sizes that scale linearly with the polynomial degree and are independent of the ambient dimension. The resulting relaxation is 10 to 100 times faster than direct nonlinear programming transcriptions solved with SNOPT and IPOPT, exhibits significantly lower variance in solve times, and reliably finds a locally optimal path for the original problem. We demonstrate its effectiveness as a convex steering function in an RRT planner for minimum-snap quadrotor planning with $C^4$ continuous trajectories.

运动规划半定规划路径优化四旋翼

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