arXiv:2607.00776cs.ROcs.SY2026-07被引 1

用函数预测方法提升动态避障的安全性与实时性

From Prediction Uncertainty to Conformalized Distance Fields for Safe Motion Planning

论文配图:From Prediction Uncertainty to Conformalized Distance Fields for Safe Motion Planning
图 1 · 摘自论文原文
  • 直接对整个障碍物距离场进行置信化,保持空间一致性
  • 在280个动态障碍场景下仍保持低延迟,计算成本几乎不随障碍物数量增加
  • 适合需要高安全性和实时性的无人机、机器人路径规划

动态环境中安全运动规划需对预测的障碍物运动不确定性进行推理,同时保证实时性能。现有方法对每个障碍物的预测误差聚合为标量分数进行置信化,丧失空间一致性且随场景密度增长而变慢。本文提出一种函数型置信化(FCP)框架,一次性对整个预测距离场进行置信化。该方法生成无需分布假设的场级下界,任何满足此约束的轨迹均被统一保证安全,与控制空间采样方式无关。关键在于残差距离场在经验上具有低秩且近似时间不变,使边界可分解于系数空间。离线通过函数PCA拟合包络,并使用高斯混合归纳置信化流程;在线则通过轻量级自适应函数置信化(AFCP)更新低维向量。该设计使每步开销基本不受障碍物数量影响,并在分布偏移下维持长期场覆盖。将该包络嵌入基于采样的模型预测控制器(FCP-MPC)中,在ETH-UCY行人基准和包含最多280个动态障碍的3D四旋翼任务中,实现安全、可行性与效率的优良平衡,优于逐点和自中心置信化基线,且每步计算远低于在线不确定性推理基线。

原文摘要 · Abstract (English)

Safe motion planning in dynamic environments requires reasoning about the uncertainty in predicted obstacle motion without sacrificing real-time performance. Existing conformal approaches conformalize a scalar score that aggregates per-obstacle prediction errors, losing spatial coherence and scaling poorly with scene density. We instead conformalize the entire predicted distance field at once. This functional conformal prediction (FCP) framework yields a distribution-free, field-level lower bound, from which safety follows uniformly: any trajectory satisfying the resulting constraint is certified safe, independent of how the control space is sampled. The key enabler is that the residual distance field is empirically low-rank and approximately time-invariant, which makes the bound decomposable in coefficient space. An envelope is fitted offline via functional PCA and a Gaussian-mixture inductive conformal procedure, then refined online by a lightweight adaptive functional conformal (AFCP) update on a low-dimensional vector. This keeps the per-step cost largely insensitive to obstacle count and retains long-run field coverage under distribution shift. We embed the envelope as a tightened safety constraint in a sampling-based model predictive controller, FCP-MPC. On the ETH--UCY pedestrian benchmarks and a dense 3D quadrotor task with up to 280 dynamic obstacles, FCP-MPC attains a favorable balance of safety, feasibility, and efficiency, reaching goals where pointwise and egocentric conformal baselines become too conservative or too expensive, while keeping per-step computation far below online uncertainty-reasoning baselines.

运动规划置信化安全控制机器人

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