Search papers, labs, and topics across Lattice.
This paper introduces a dual-barrier control barrier function (CBF) safety filter for holonomic robots navigating incrementally built occupancy grid maps, ensuring safety by avoiding both mapped obstacles and unexplored regions. The filter uses a closed-form solution derived from the occupancy grid's signed distance field, resulting in low computational overhead suitable for resource-constrained platforms. Experimental results on a PX4-controlled quadrotor demonstrate collision-free operation in indoor environments.
Guaranteeing robot safety in unknown environments doesn't require complex planning – this closed-form CBF filter does it with minimal computation.
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.