We introduce a novel method for mobile robot navigation in dynamic, unknown environments, leveraging onboard sensing and distributionally robust optimization to impose probabilistic safety constraints. Our method introduces a distributionally robust control barrier function (DR-CBF) that directly integrates noisy sensor measurements and state estimates to define safety constraints. This approach is applicable to a wide range of control-affine dynamics, generalizable to robots with complex geometries, and capable of operating at real-time control frequencies. Coupled with a control Lyapunov function (CLF) for path following, the proposed CLF-DR-CBF control synthesis method achieves safe, robust, and efficient navigation in challenging environments. We demonstrate the effectiveness and robustness of our approach for safe autonomous navigation under uncertainty and dynamic obstacles in simulations and real-world experiments with differential-drive robots.
AbdiHRajaGGhabchelooR (2023) Safe control using vision-based control barrier function (V-CBF). In: IEEE International Conference on Robotics and Automation (ICRA), pp. 782–788. IEEE.
2.
AbuaishASrinivasanMVelaPA (2023) Geometry of radial basis neural networks for safety biased approximation of unsafe regions. In: 2023 American Control Conference (ACC), pp. 1459–1466. IEEE.
3.
AgrawalDRPanagouD (2021) Safe control synthesis via input constrained control barrier functions. In: 2021 60th IEEE Conference on Decision and Control (CDC), pp. 6113–6118. IEEE.
4.
AmesADXuXGrizzleJW, et al. (2017) Control barrier function based quadratic programs for safety critical systems. IEEE Transactions on Automatic Control62(8): 3861–3876.
5.
AmesACooganSEgerstedtM, et al. (2019) Control barrier functions: theory and applications. In: European Control Conference (ECC), pp. 3420–3431. IEEE.
6.
AnderssonJAEGillisJHornG, et al. (2019) CasADi – a software framework for nonlinear optimization and optimal control. Mathematical Programming Computation11(1): 1–36. DOI: 10.1007/s12532-018-0139-4.
7.
AolariteiLFochesatoMLygerosJ, et al. (2023) Wasserstein tube MPC with exact uncertainty propagation. In: IEEE Conference on Decision and Control (CDC), pp. 2036–2041. IEEE.
8.
ArslanOKoditschekDE (2019) Sensor-based reactive navigation in unknown convex sphere worlds. The International Journal of Robotics Research38(2-3): 196–223.
BajcsyABansalSBronsteinE, et al. (2019) An efficient reachability-based framework for provably safe autonomous navigation in unknown environments. In: 2019 IEEE 58th Conference on Decision and Control (CDC), pp. 1758–1765. IEEE.
11.
BoffiNTuSMatniN, et al. (2021) Learning stability certificates from data. In: Conference on Robot Learning, pp. 1341–1350. PMLR.
12.
BorensteinJKorenY (1991) The vector field histogram-fast obstacle avoidance for mobile robots. IEEE Transactions on Robotics and Automation7(3): 278–288.
13.
BoskosDCortésJMartínezS (2023) Data-driven distributionally robust coverage control by mobile robots. In: IEEE Conference on Decision and Control (CDC), pp. 2030–2035. IEEE.
14.
BoskosDCortésJMartínezS (2024) High-confidence data-driven ambiguity sets for time-varying linear systems. IEEE Transactions on Automatic Control69(2): 797–812.
15.
BreedenJPanagouD (2023) Robust control barrier functions under high relative degree and input constraints for satellite trajectories. Automatica155: 111109.
16.
BritoBFloorBFerrantiL, et al. (2019) Model predictive contouring control for collision avoidance in unstructured dynamic environments. IEEE Robotics and Automation Letters4(4): 4459–4466.
17.
ChangYCRoohiNGaoS (2019) Neural Lyapunov control. In: Advances in Neural Information Processing Systems, Vol. 32.
18.
ChatilaRLaumondJ (1985) Position referencing and consistent world modeling for mobile robots. In: IEEE International Conference on Robotics and Automation (ICRA), Vol. 2, 138–145. IEEE.
19.
ChenPPeiJLuW, et al. (2022) A deep reinforcement learning based method for real-time path planning and dynamic obstacle avoidance. Neurocomputing497: 64–75.
20.
ChoiJJCastañedaFJungW, et al. (2023) Constraint-guided online data selection for scalable data-driven safety filters in uncertain robotic systems. arXiv preprint arXiv:2311.13824.
21.
ChriatASunC (2024) Wasserstein distributionally robust control barrier function using conditional value-at-risk with differentiable convex programming. In: AIAA SCITECH 2024 Forum, p. 0725. AIAA.
22.
ClarkA (2019) Control barrier functions for complete and incomplete information stochastic systems. In: 2019 American Control Conference (ACC), pp. 2928–2935. DOI: 10.23919/ACC.2019.8814901.
23.
ClarkeFH (1981) Generalized gradients of lipschitz functionals. Advances in Mathematics40(1): 52–67.
24.
CorkePTrevelyanJBrockO, et al. (2000) Elastic strips: a framework for integrated planning and execution. In: Experimental Robotics VI, pp. 329–338. Springer.
DaiHJiangCZhangH, et al. (2024) Verification and synthesis of compatible control lyapunov and control barrier functions. In: 2024 IEEE 63rd Conference on Decision and Control (CDC), pp. 8178–8185. DOI: 10.1109/CDC56724.2024.10885943.
27.
DasEBurdickJW (2024) Robust control barrier functions using uncertainty estimation with application to mobile robots. arXiv preprint arXiv:2401.01881.
28.
DaşEMurrayRM (2022) Robust safe control synthesis with disturbance observer-based control barrier functions. In: IEEE Conference on Decision and Control (CDC), pp. 5566–5573. IEEE.
29.
DawsonCLowenkampBGoffD, et al. (2022) Learning safe, generalizable perception-based hybrid control with certificates. IEEE Robotics and Automation Letters7(2): 1904–1911.
30.
De LimaDAPereiraGAS (2013) Navigation of an autonomous car using vector fields and the dynamic window approach. Journal of Control, Automation and Electrical Systems24: 106–116.
31.
DesaiMGhaffariA (2022) CLF-CBF based quadratic programs for safe motion control of nonholonomic mobile robots in presence of moving obstacles. In: IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), pp. 16–21. IEEE.
32.
DhimanVKhojastehMJFranceschettiM, et al. (2023) Control barriers in bayesian learning of system dynamics. IEEE Transactions on Automatic Control68(1): 214–229.
33.
DijkstraEW (1959) A note on two problems in connexion with graphs. Numerische Mathematik1: 269–271.
34.
DixitALindemannLWeiSX, et al. (2023) Adaptive conformal prediction for motion planning among dynamic agents. In: Learning for Dynamics and Control Conference, pp. 300–314. PMLR.
35.
DjuricPMKotechaJHZhangJ, et al. (2003) Particle filtering. IEEE Signal Processing Magazine20(5): 19–38.
36.
DudekGJenkinMMiliosE, et al. (1978) Robotic exploration as graph construction. IEEE Transactions on Robotics and Automation7(3): 859–865.
37.
EmamYGlotfelterPWilsonS, et al. (2022) Data-driven robust barrier functions for safe, long-term operation. IEEE Transactions on Robotics38(3): 1671–1685.
38.
EsfahaniPMKuhnD (2018) Data-driven distributionally robust optimization using the Wasserstein metric: performance guarantees and tractable reformulations. Mathematical Programming171: 115–166.
39.
EverettMChenYFHowJP (2021) Collision avoidance in pedestrian-rich environments with deep reinforcement learning. IEEE Access9: 10357–10377.
40.
FitzpatrickS (1980) Metric projections and the differentiability of distance functions. Bulletin of the Australian Mathematical Society22(2): 291–312.
41.
FoxDBurgardWThrunS (1997) The dynamic window approach to collision avoidance. IEEE Robotics and Automation Magazine4: 23–33.
42.
FrazzoliEDahlehMAFeronE (2002) Real-time motion planning for agile autonomous vehicles. Journal of Guidance, Control, and Dynamics25(1): 116–129.
43.
GaroneENicotraMM (2015) Explicit reference governor for constrained nonlinear systems. IEEE Transactions on Automatic Control61(5): 1379–1384.
44.
GrandiaRTaylorAJAmesAD, et al. (2021) Multi-layered safety for legged robots via control barrier functions and model predictive control. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 8352–8358. IEEE.
45.
GrisettiGKümmerleRStachnissC, et al. (2010) A tutorial on graph-based slam. IEEE Intelligent Transportation Systems Magazine2(4): 31–43.
46.
HakobyanAYangI (2022) Distributionally robust risk map for learning-based motion planning and control: a semidefinite programming approach. IEEE Transactions on Robotics39(1): 718–737.
47.
HamdipoorVMeskinNCassandrasCG (2023) Safe control synthesis using environmentally robust control barrier functions. European Journal of Control74: 100840, 2023 European Control Conference Special Issue.
48.
HanLGaoFZhouB, et al. (2019) Fiesta: fast incremental euclidean distance fields for online motion planning of aerial robots. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 4423–4430. IEEE.
49.
HartPENilssonNJRaphaelB (1968) A formal basis for the heuristic determination of minimum cost paths. IEEE Transactions on Systems Science and Cybernetics4(2): 100–107.
50.
HelbingDMolnarP (1995) Social force model for pedestrian dynamics. Physical Review E51(5): 4282–4286.
51.
HerbertSLChenMHanS, et al. (2017) FaSTrack: a modular framework for fast and guaranteed safe motion planning. In: IEEE Conference on Decision and Control (CDC), pp. 1517–1522. IEEE.
52.
HotaARCherukuriAKLygerosJ (2019) Data-driven chance constrained optimization under Wasserstein ambiguity sets. In: American Control Conference (ACC), pp. 1501–1506.
53.
HuangJKGrizzleJW (2023) Efficient anytime clf reactive planning system for a bipedal robot on undulating terrain. IEEE Transactions on Robotics39(3): 2093–2110.
54.
İşleyenAvan de WouwNArslanÖ (2023) Feedback motion prediction for safe unicycle robot navigation. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 10511–10518. IEEE.
55.
Jarvis-WloszekZFeeleyRTanW, et al. (2003) Some controls applications of sum of squares programming. In: 42nd IEEE International Conference on Decision and Control, Vol. 5, pp. 4676–4681. DOI: 10.1109/CDC.2003.1272309.
KalmanRE (1960) A new approach to linear filtering and prediction problems. Journal of Basic Engineering82: 35–45.
58.
KeyumarsiSAtmanMWSGusrialdiA (2024) Lidar-based online control barrier function synthesis for safe navigation in unknown environments. IEEE Robotics and Automation Letters9(2): 1043–1050.
59.
KhalilHK (2002) Control of Nonlinear Systems. New York, NY: Prentice Hall.
60.
KhatibO (1986) Real-time obstacle avoidance for manipulators and mobile robots. The International Journal of Robotics Research5(1): 90–98.
61.
KhazoomCGonzalez-DiazDDingY, et al. (2022) Humanoid self-collision avoidance using whole-body control with control barrier functions. In: IEEE International Conference on Humanoid Robots (Humanoids), pp. 558–565. IEEE.
62.
KoenigNHowardA (2004) Design and use paradigms for gazebo, an open-source multi-robot simulator. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Vol. 3, pp. 2149–2154. IEEE.
63.
KohlbrecherSvon StrykOMeyerJ, et al. (2011) A flexible and scalable slam system with full 3d motion estimation. In: IEEE International Symposium on Safety, Security, and Rescue Robotics, pp. 155–160. IEEE.
64.
KondoKFigueroaRRachedJ, et al. (2023) Robust mader: decentralized multiagent trajectory planner robust to communication delay in dynamic environments. In: IEEE Robotics and Automation Letters. IEEE.
65.
KoptevMFigueroaNBillardA (2023) Neural joint space implicit signed distance functions for reactive robot manipulator control. IEEE Robotics and Automation Letters8(2): 480–487. DOI: 10.1109/LRA.2022.3227860.
LiZArslanÖAtanasovN (2020) Fast and safe path-following control using a state-dependent directional metric. In: IEEE International Conference on Robotics and Automation (ICRA), pp. 6176–6182. IEEE.
68.
LiJLiuQJinW, et al. (2023) Robust safe learning and control in an unknown environment: an uncertainty-separated control barrier function approach. IEEE Robotics and Automation Letters8(10): 6539–6546.
69.
LiYZhangYRazmjooA, et al. (2024) Representing robot geometry as distance fields: applications to whole-body manipulation. In: Proceedings IEEE Intl Conf. On Robotics and Automation (ICRA), pp. 15351–15357. IEEE.
70.
LindemannLCleavelandMShimG, et al. (2023) Safe planning in dynamic environments using conformal prediction. IEEE Robotics and Automation Letters8(8): 5116–5123.
71.
LiuJAduCELymburnerL, et al. (2023a) Radius: risk-aware, real-time, reachability-based motion planning. In: Robotics: Science and Systems (RSS).
72.
LiuJLiMHuangJK, et al. (2023b) Realtime safety control for bipedal robots to avoid multiple obstacles via CLF-CBF constraints. arXiv preprint arXiv:2301.01906.
73.
LiuSLiuCDolanJ (2023c) Safe control under input limits with neural control barrier functions. In: Conference on Robot Learning, pp. 1970–1980. PMLR.
74.
LongKQianCCortésJ, et al. (2021) Learning barrier functions with memory for robust safe navigation. IEEE Robotics and Automation Letters6(3): 4931–4938.
75.
LongKDhimanVLeokM, et al. (2022) Safe control synthesis with uncertain dynamics and constraints. IEEE Robotics and Automation Letters7(3): 7295–7302.
76.
LongKYiYCortesJ, et al. (2023a) Distributionally robust Lyapunov function search under uncertainty. In: Learning for Dynamics and Control Conference, pp. 864–877. PMLR.
77.
LongKYiYCortésJ, et al. (2023b) Safe and stable control synthesis for uncertain system models via distributionally robust optimization. In: American Control Conference (ACC), pp. 4651–4658.
78.
LongKCortésJAtanasovN (2024) Distributionally robust policy and lyapunov-certificate learning. IEEE Open Journal of Control Systems3: 375–388.
79.
Lozano-Perez (1983) Spatial planning: a configuration space approach. IEEE Transactions on ComputersC-32(2): 108–120.
80.
MajdKYaghoubiSYamaguchiT, et al. (2021) Safe navigation in human occupied environments using sampling and control barrier functions. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 5794–5800. IEEE.
81.
MestresPAllibhoyACortésJ (2023) Robinson’s counterexample and regularity properties of optimization-based controllers. arXiv preprint arXiv:2410.08364.
82.
MestresPLongKAtanasovN, et al. (2024a) Feasibility analysis and regularity characterization of distributionally robust safe stabilizing controllers. IEEE Control Systems Letters8: 91–96.
83.
MestresPNieto-GrandaCCortésJ (2024b) Safe and dynamically-feasible motion planning using control lyapunov and barrier functions. arXiv preprint arXiv:2410.08364.
84.
MoussaïdMPerozoNGarnierS, et al. (2010) The walking behaviour of pedestrian social groups and its impact on crowd dynamics. PLoS One5(4): e10047.
85.
NemirovskiAShapiroA (2006) Convex approximations of chance constrained programs. SIAM Journal on Optimization17: 969–996.
86.
OleynikovaHTaylorZFehrM, et al. (2017) Voxblox: incremental 3d Euclidean signed distance fields for on-board MAV planning. In: 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 1366–1373. IEEE.
87.
ParkJJFlorencePStraubJ, et al. (2019) DeepSDF: learning continuous signed distance functions for shape representation. In: Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, pp. 165–174. IEEE.
88.
ParwanaHMustafaAPanagouD (2022) Trust-based rate-tunable control barrier functions for non-cooperative multi-agent systems. In: 2022 IEEE 61st Conference on Decision and Control (CDC), pp. 2222–2229. IEEE.
89.
PfeifferMShuklaSTurchettaM, et al. (2018) Reinforced imitation: sample efficient deep reinforcement learning for mapless navigation by leveraging prior demonstrations. IEEE Robotics and Automation Letters3(4): 4423–4430.
90.
PrajnaSJadbabaieA (2004) Safety verification of hybrid systems using barrier certificates. In: International Workshop on Hybrid Systems: Computation and Control, pp. 477–492. Springer.
91.
RenAZMajumdarA (2022) Distributionally robust policy learning via adversarial environment generation. IEEE Robotics and Automation Letters7(2): 1379–1386.
92.
RimonEKoditschekDE (1992) Exact robot navigation using artificial potential functions. IEEE Transactions on Robotics and Automation8(5): 501–518.
93.
RockafellarRTUryasevS (2000) Optimization of conditional value-at-risk. Journal of Risk2: 21–41.
RyuKMehrN (2024) Integrating predictive motion uncertainties with distributionally robust risk-aware control for safe robot navigation in crowds. In: 2024 IEEE International Conference on Robotics and Automation (ICRA), pp. 2410–2417. IEEE.
96.
SchaeferSLeungKIvanovicB, et al. (2021) Leveraging neural network gradients within trajectory optimization for proactive human-robot interactions. In: 2021 IEEE International Conference on Robotics and Automation (ICRA), pp. 9673–9679. IEEE.
97.
ShaferGVovkV (2008) A tutorial on conformal prediction. Journal of Machine Learning Research9(3): 371.
98.
SontagED (1989) A ‘universal’ construction of Artstein’s theorem on nonlinear stabilization. Systems & Control Letters13(2): 117–123.
99.
SummersT (2018) Distributionally robust sampling-based motion planning under uncertainty. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 6518–6523. IEEE.
100.
Van ParysBPGKuhnDGoulartPJ, et al. (2016) Distributionally robust control of constrained stochastic systems. IEEE Transactions on Automatic Control61(2): 430–442.
101.
WangYXuX (2023) Disturbance observer-based robust control barrier functions. In: American Control Conference (ACC), pp. 3681–3687.
102.
WuLLeeKMBLiuL, et al. (2021) Faithful Euclidean distance field from log-Gaussian process implicit surfaces. IEEE Robotics and Automation Letters6(2): 2461–2468.
103.
WuLLeeKMBLe GentilC, et al. (2023) Log-gpis-mop: a unified representation for mapping, odometry, and planning. IEEE Transactions on Robotics39(5): 4078–4094.
104.
XiaoWWangTHChahineM, et al. (2022) Differentiable control barrier functions for vision-based end-to-end autonomous driving. arXiv preprint arXiv:2203.02401.
105.
XieW (2021) On distributionally robust chance constrained programs with Wasserstein distance. Mathematical Programming186: 115–155.
106.
YangWGongZHuangB, et al. (2022) Lidar with velocity: correcting moving objects point cloud distortion from oscillating scanning lidars by fusion with camera. IEEE Robotics and Automation Letters7(3): 8241–8248.
107.
YangSPappasGJMangharamR, et al. (2023) Safe perception-based control under stochastic sensor uncertainty using conformal prediction. In: IEEE Conference on Decision and Control (CDC), pp. 6072–6078. IEEE.
108.
YuHHirayamaCYuC, et al. (2023) Sequential neural barriers for scalable dynamic obstacle avoidance. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 11241–11248. IEEE.
109.
ZhangSGargKFanC (2023) Neural graph control barrier functions guided distributed collision-avoidance multi-agent control. In: Conference on Robot Learning (CoRL). PMLR, 2373–2392.
110.
ZhangYTianGWenL, et al. (2024) Online efficient safety-critical control for mobile robots in unknown dynamic multi-obstacle environments. arXiv preprint arXiv:2402.16449.
111.
ZhaoYYuXDeshmukhJV, et al. (2024) Conformal predictive programming for chance constrained optimization. arXiv preprint arXiv:2402.07407.
Supplementary Material
Please find the following supplemental material available below.
For Open Access articles published under a Creative Commons License, all supplemental material carries the same license as the article it is associated with.
For non-Open Access articles published, all supplemental material carries a non-exclusive license, and permission requests for re-use of supplemental material or any part of supplemental material shall be sent directly to the copyright owner as specified in the copyright notice associated with the article.
