为移动机器人设计安全速度控制器,防止撞上未知区域和已知障碍物。
A Closed-Form Dual-Barrier CBF Safety Filter for Holonomic Robots on Incrementally Built Occupancy Grid Maps

- 基于栅格地图的符号距离场,构建双屏障安全约束。
- 在树莓派上每周期仅需小规模线性求解,计算开销极低。
- 适合资源受限平台,可与学习类控制策略无缝集成。
我们提出一种双屏障控制屏障函数(CBF)安全滤波器,用于在增量构建的占用栅格地图中实现全向机器人的实时、安全关键速度控制。当机器人探索未知环境时,未测绘区域因障碍物几何形状未知而引入不可消除的不确定性,导致进入此类区域存在碰撞风险,尤其在使用前向传感器时更为明显。为此,我们施加两个约束:避开已映射障碍物,禁止进入未探索区域。两个约束均从占用栅格的符号距离场中解析导出,形成闭式安全滤波器,每周期仅需求解一个小型线性系统。在计算资源受限平台(如树莓派)上,该滤波器开销极低,保留了用于SLAM和规划的计算资源。自适应增益调度在信息丰富的区域放松前沿约束,在已良好映射区域收紧约束,提升探索效率同时保障安全。滤波器在速度空间中作为最小侵入性修正,可与任意名义控制器(包括基于学习的方法)组合。在PX4控制的四旋翼飞行器上进行的硬件飞行实验表明,在多次室内运行中均实现零碰撞。
原文摘要 · Abstract (English)
We present a dual-barrier control barrier function (CBF) safety filter for real-time, safety-critical velocity control of holonomic robots operating in incrementally built occupancy grid maps. As a robot explores an unknown environment, unmapped regions introduce irreducible uncertainty, since obstacle geometry beyond the explored frontier is unknown, making entry into such regions a source of collision risk, especially with front-facing sensors. To address this, we enforce two constraints: avoidance of mapped obstacles and restriction from unexplored regions. Both constraints are derived analytically from the occupancy grid's signed distance field, yielding a closed-form safety filter that requires only a small linear system solve per cycle. On resource-constrained platforms such as the Raspberry Pi, where SLAM and planning already consume significant compute, the low overhead of the proposed filter preserves resources. An adaptive gain schedule relaxes the frontier constraint in information-rich regions and tightens it in well-mapped areas, improving exploration efficiency while maintaining safety. The filter operates in velocity space as a minimally invasive correction and composes with arbitrary nominal controllers, including learning-based methods. Hardware flight experiments on a PX4-controlled quadrotor demonstrate zero collisions across multiple indoor runs.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。