Radar-Native Control Barrier Functions: Doppler Range Rate as a Measured Barrier Derivative
Authors: Johannes Mootz, Hesam Mojtahedi, Reza Akhavian
Organizations: Department of Civil, Construction, and Environmental Engineering, San Diego State University, San Diego, CA 92182, USA. · Department of Mechanical and Aerospace Engineering, University of California San Diego, La Jolla, CA 92093, USA. · Department of Electrical and Computer Engineering, University of California San Diego, La Jolla, CA 92093, USA.
Safe control around dynamic obstacles requires information about both distance and relative motion. Range-based filters commonly reconstruct the required range rate from successive range measurements or from obstacle-state estimators, which can introduce estimator delay or sensitivity to range noise when obstacle motion changes. A frequency-modulated continuous-wave (FMCW) radar measures radial relative velocity directly through Doppler. We use this measurement as the derivative of an ego-centered range control barrier function (CBF) and obtain a closed-form filter on the robot's forward velocity. A measurement margin constructed from sensor error bounds accounts for errors in range, Doppler, ego velocity, and bearing. In 508 paired encounters within the platform's retreat capability, direct Doppler produces two buffer incursions, compared with 15 for a constant-acceleration and 25 for a constant-velocity Kalman filter. On a Unitree Go1, the controller stops at 0.777±0.015 m against the predicted 0.758 m and reacts to a farther approaching object while a nearer static return remains. The guarantee covers the longitudinal range channel under bounded measurement errors and continuously available detections. Direct Doppler removes the need to reconstruct range rate in the safety loop, reducing the delay between a change in obstacle motion and its effect on the safety command.
Figures & tables
Fig. 1: Planar radar measurement model. A return from the obstacle is observed at range R^ and bearing γ^ relative to the robot’s heading. The obstacle velocity vo is decomposed into radial and tangential components vo,r and vo,t .
Parameter
Value
Parameter
Value
α
1s−1
Radar frequency
20Hz
Rsafe
0.50m
Range bin
0.049m
eˉR˙
0.15m/s
Doppler bin
0.189m/s
eˉR
0.04m
Command delay
0.15 – 0.20s
eˉv
0.04m/s
vdes
0.20m/s
eˉγ
3∘
vback
0.30m/s
TABLE I: Parameters used in simulation and on the robot.
Fig. 2: Response to a change in obstacle motion. (a) Range rate supplied to the safety filter. (b) Forward velocity command. (c) True surface separation.
Range rate
Incursions
Near
p95 depth
Retreat
Latency
source
/508
/54
[m]
[m]
[s]
True R˙
0
0
0.000
0.213
0.00
Doppler
2
1
0.000
0.233
0.00
KF-A
15
15
0.027
0.210
0.06
KF-V
25
16
0.042
0.280
0.06
ΔR/Δt
98
21
0.076
0.126
0.06
TABLE II: Paired sweep over the 508 evaluable encounters. Bold entries mark the best deployable safety and response values. Retreat is the cost of that safety and has no preferred direction.
Fig. 3: Minimum true barrier value in the same encounter under Doppler and under (a) KF-V or (b) KF-A. Open circles are near-boundary encounters. The shaded quadrant contains cases held by Doppler and lost by the range-rate estimator, and vice versa.
Fig. 4: Incursion rate over the 508 encounters against mean retreat as margin is added to each range-rate source. Labels give the added margin in m/s . The triangle is the true range rate with the same operating margin. Vertical bars are 95% Wilson intervals for the incursion rate.
Fig. 5: Composite illustration of the hardware and test sequence. The robot first approaches the static object O1 and stops. A second object O2 then approaches from farther away. The reported dynamic trials use a person or a moving robot.
Fig. 6: Representative two-object pass. (a) Object ranges and the return that sets the minimum cap. (b) Doppler range rate of the approaching-object group. (c) Doppler, nearest-return, and static-assumption commands.
Range-rate
Response
Lag vs.
Stationary retreat
source
[count]
Doppler [s]
[% frames]
Radar KF-V
22/23
+0.15
5.3
Radar KF-A
22/23
+0.08
8.6
Radar ΔR/Δt
23/23
+0.25
23.6
Depth KF-V
9/9
+0.25
5.7
Depth KF-A
9/9
+0.20
7.1
TABLE III: Hardware comparison of range-rate sources. Doppler defines the reference sets for response and retreat activity. Lag is the median delay of the first retreat command relative to Doppler; positive values indicate later responses.
Safety filters are an effective tool for enforcing constraints in safety-critical systems, but most existing methods assume perfect state information, which is rarely available in practice. Recent work has begun to close this gap by developing filtering mechanisms that are robust to state estimation error, but these methods can still exhibit safety violations or overly conservative behavior as estimation error grows. Focusing on obstacle avoidance, we develop two new control barrier function (CBF) formulations: drift-measurement-robust (DMR)-CBFs and neural measurement-robust (NMR)-CBFs. The DMR-CBF augments the standard CBF condition with an inner optimization over the worst-case uncertainty in the drift dynamics, improving robustness to estimation error. This DMR-CBF then supervises a pretraining phase for the NMR-CBF, which replaces the inner optimization with a learned term. The NMR-CBF is subsequently finetuned through differentiable trajectory rollouts, yielding a filter that achieves empirical safety comparable to the DMR-CBF while reducing both conservativeness and computational cost. We provide theoretical analysis of the DMR-CBF along with numerical results on a planar double integrator and a 12D quadrotor, where both proposed approaches prevent collisions while other robust methods either fail or are overly conservative. Finally, we deployed the NMR-CBF on a Unitree Go2, enabling successful navigation of an obstacle field under odometry errors that caused a standard CBF to collide.
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.
The collision cone used by velocity-space control barrier functions is conservative: it rejects every relative velocity aimed into an obstacle, however slow. We propose the shifted collision-cone CBF (SC3BF), which adds a state-dependent allowance to the cone condition, so the robot may approach the obstacle at a rate that grows with distance and with its own speed. SC3BF is enforced by an ordinary quadratic program, and its safe set is forward invariant under bounded inputs without a minimum forward speed or a clearance margin. We prove that a nonzero allowance preserving safety always exists, and derive one in closed form. Against three velocity-space baselines on a kinematic bicycle among up to 100 moving obstacles, SC3BF reaches the goal more often and modifies the nominal input less than half as much.
Amin Kashiri, Yasin Yazıcıoğlu
Department of Electrical and Computer Engineering at Northeastern University, Boston, MA · Departments of Mechanical and Industrial Engineering and Electrical and Computer Engineering at Northeastern University, Boston, MA