arXiv:2604.07599cs.RO2026-04被引 1

SANDO实现动态未知环境下的快速安全飞行规划,兼顾实时性与零碰撞保障。

SANDO: Safe Autonomous Trajectory Planning for Dynamic Unknown Environments

论文配图:SANDO: Safe Autonomous Trajectory Planning for Dynamic Unknown Environments
图 1 · 摘自论文原文
  • 用热力图引导全局路径避开高风险区,时空安全走廊仅按最坏可达集膨胀障碍物
  • 通过变量消去的混合整数二次规划,优化速度提升7.4倍,计算高效且保证无碰撞
  • 适合无人机等自主系统在复杂动态环境中实现闭环安全飞行,实测10次动态避障成功

SANDO是一种面向三维动态未知环境的安全轨迹规划方法,其中障碍物位置和运动事先未知,且无碰撞路径可能随时失效,需快速重规划。现有软约束方法虽快但无法保证无碰撞,硬约束方法虽安全却计算耗时。SANDO通过三项贡献解决该权衡:首先,基于热力图的A*全局规划器使用软代价引导路径避开高风险区域;时空安全飞行走廊(STSFC)生成器在每时间层仅以障碍物最坏可达集膨胀,而非整个时间窗口的最坏情况。其次,轨迹优化建模为带硬碰撞规避约束的混合整数二次规划(MIQP),并采用变量消去技术减少决策变量,实现快速求解。第三,形式化安全分析在显式速度边界和估计误差假设下提供碰撞自由保证。消融实验表明,变量消去使优化时间最多提升7.4倍,而STSFC对密集动态环境中的可行性至关重要。在标准静态基准、障碍物密集的森林及动态环境上的基准仿真中,SANDO始终以最高成功率达成无约束违规,表现优于当前最优方法。感知仅依赖实验(无真值障碍信息)验证了其在真实感知条件下的鲁棒性。硬件实验在全机载感知、规划与定位的无人机上完成,静态环境实现6次安全飞行,动态障碍物中实现10次安全飞行。

原文摘要 · Abstract (English)

SANDO is a safe trajectory planner for 3D dynamic unknown environments, where obstacle locations and motions are unknown a priori and a collision-free plan can become unsafe at any moment, requiring fast replanning. Existing soft-constraint planners are fast but cannot guarantee collision-free paths, while hard-constraint methods ensure safety at the cost of longer computation. SANDO addresses this trade-off through three contributions. First, a heat map-based A* global planner steers paths away from high-risk regions using soft costs, and a spatiotemporal safe flight corridor (STSFC) generator produces time-layered polytopes that inflate obstacles only by their worst-case reachable set at each time layer, rather than by the worst case over the entire horizon. Second, trajectory optimization is formulated as a Mixed-Integer Quadratic Program (MIQP) with hard collision-avoidance constraints, and a variable elimination technique reduces the number of decision variables, enabling fast computation. Third, a formal safety analysis establishes collision-free guarantees under explicit velocity-bound and estimation-error assumptions. Ablation studies show that variable elimination yields up to 7.4x speedup in optimization time, and that STSFCs are critical for feasibility in dense dynamic environments. Benchmark simulations against state-of-the-art methods across standardized static benchmarks, obstacle-rich static forests, and dynamic environments show that SANDO consistently achieves the highest success rate with no constraint violations across all difficulty levels; perception-only experiments without ground truth obstacle information confirm robust performance under realistic sensing. Hardware experiments on a UAV with fully onboard planning, perception, and localization demonstrate six safe flights in static environments and ten safe flights among dynamic obstacles.

轨迹规划无人机安全飞行动态避障

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