Radar-Native Control Barrier Functions: Doppler Range Rate as a Measured Barrier Derivative
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.
Abstract
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 m against the predicted 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
| Parameter | Value | Parameter | Value |
|---|---|---|---|
| Radar frequency | |||
| Range bin | |||
| Doppler bin | |||
| Command delay | – | ||
| Range rate | Incursions | Near | p95 depth | Retreat | Latency |
|---|---|---|---|---|---|
| source | /508 | /54 | [m] | [m] | [s] |
| True | 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 |
| 98 | 21 | 0.076 | 0.126 | 0.06 |
| 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 | 23/23 | +0.25 | 23.6 |
| Depth KF-V | 9/9 | +0.25 | 5.7 |
| Depth KF-A | 9/9 | +0.20 | 7.1 |
Robot Collision Avoidance
Robot collision avoidance develops sensing, planning, and control methods that keep robots safely separated from people, obstacles, and other robots.
See all 187 papers