arXiv:2606.26413eess.SYcs.RO2026-06

PRISM在不确定环境下高效规划,兼顾高覆盖率与低路径成本。

PRISM: Efficient and Locally Optimal Probabilistic Planning with Reachability Guarantees

论文配图:PRISM: Efficient and Locally Optimal Probabilistic Planning with Reachability Guarantees
图 1 · 摘自论文原文
  • 将信念空间规划分解为均值路径与协方差收缩两步,提升效率
  • 在复杂场景中实现97%-100%覆盖率,优于现有方法(<45%)
  • 适合需要高可靠性路径规划的机器人系统应用

在运动不确定性与状态、控制约束下,信念空间规划仍面临根本挑战,主要源于受限信念空间中难以建立可达性保证。现有方法依赖采样构建多查询信念路网,并显式寻找采样节点间的可行轨迹以建立可达性,但常无法覆盖完整信念空间,或使用鲁棒控制技术虽提升覆盖却导致高成本轨迹;且缺乏有限时间或有限内存完备性保证。本文提出PRISM,一种针对带状态与控制约束的信念空间的多查询运动规划算法,旨在同时实现高覆盖率与低成本。我们提出了一个关于受约束下状态协方差可控性的新结论,用于将信念空间规划分解为确定性均值规划与协方差收缩。PRISM进一步引入在线局部优化方法,降低可行信念空间轨迹的成本。在起始与目标分布满足弱假设条件下,证明了PRISM在执行器与障碍物约束下仍能保证完全覆盖(即完备性)。在挑战性模拟场景中,PRISM的路网覆盖率显著高于当前最优信念空间规划方法,且轨迹均值成本与成本方差更低。例如,在易与中等难度场景中达到100%覆盖率;在最困难场景(违反覆盖率假设)中仍达97%-100%,而所有其他方法均低于45%。

原文摘要 · Abstract (English)

Belief-space planning under motion uncertainty and state and control constraints remains a fundamental challenge, largely due to the difficulty of establishing reachability guarantees in constrained belief spaces. Existing constrained belief-space planners rely on sampling to construct multi-query belief roadmaps and explicitly find feasible trajectories between sampled nodes to establish reachability. These methods often struggle to cover the belief space or use robust control techniques that improve coverage at the cost of indirect, high-cost trajectories; they also lack finite-time or finite-memory completeness guarantees. We propose PRISM, a multi-query motion planning algorithm for belief spaces with state and control constraints that targets both high coverage and low cost. We present a new result on controllability of the state covariance under constraints, which is used by PRISM to decompose belief-space planning into deterministic mean planning and covariance shrinking. PRISM further includes an online local optimization method that reduces the cost of feasible belief-space trajectories. Under mild assumptions on the start and goal distributions, we prove that PRISM guarantees full coverage (i.e. completeness) despite actuator and obstacle constraints. In challenging simulated scenarios, PRISM achieves substantially higher roadmap coverage than state-of-the-art belief-space planning methods while producing trajectories with lower mean cost and cost variance. For example, PRISM achieves 100% coverage in easy and medium-difficulty scenarios, and, in the hardest scenario, which violates PRISM's coverage assumptions, it still achieves 97-100% coverage, while all other methods achieve less than 45%.

运动规划信念空间不确定性机器人

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