SC3BF: Shifted Collision Cone Control Barrier Function for Dynamic Obstacle Avoidance
Organizations: 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
Abstract
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 \emph{shifted collision-cone CBF} (SC3BF), which adds a state-dependent \emph{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 moving obstacles, SC3BF reaches the goal more often and modifies the nominal input less than half as much.
Figures & tables
| 20 obstacles | 50 obstacles | 100 obstacles | ||||
| Method | succ. | interv. | succ. | interv. | succ. | interv. |
| C3BF [ 5 ] | 22 % | 0.470 | 6 % | 0.440 | 0 % | – |
| VOCBF [ 11 ] | 53 % | 0.119 | 38 % | 0.488 | 12 % | 0.724 |
| DPCBF [ 7 ] | 84 % | 0.357 | 48 % | 0.542 | 17 % | 0.684 |
| SC3BF, | 91 % | 0.052 | 62 % | 0.120 | 22 % | 0.222 |
| SC3BF, | 92 % | 0.053 | 67 % | 0.131 | 27 % | 0.229 |