Adaptive High-Order Control Barrier Function-Based Iterative LQR for Real Time Safety-Critical Motion Planning

Xiangyu Kong,Wentao Ning,Yuanqing Xia,Zhongqi Sun,Huahui Xie
DOI: https://doi.org/10.1109/lra.2024.3398506
IF: 5.2
2024-01-01
IEEE Robotics and Automation Letters
Abstract:This letter proposes an adaptive high-order control barrier function-based iterative linear quadratic regulator (AHOCBF-ILQR) algorithm for real time safety-critical motion planning. Firstly, we propose a HOCBF-ILQR method, where a HOCBF-based controller is designed as a safety filter of ILQR to guarantee safety. Then, to address the potential infeasibility issue in HOCBF-ILQR, AHOCBF-ILQR is proposed by introducing an auxiliary variable. In AHOCBF-ILQR, only an unconstrained optimization problem and a quadratic programming need to be solved within a sampling interval. The low computation burden significantly enhances the time efficiency of AHOCBF-ILQR. Furthermore, we provide theoretical proof of the safety and feasibility of AHOCBF-ILQR. The algorithms are tested by motion planning experiments for a wheeled mobile robot, where the robot is required to navigate around static or moving obstacles that are unknown in advance. The experimental results show that AHOCBF-ILQR can solve the control inputs within $\text{0.05}~s$ , and ensure safety.
What problem does this paper attempt to address?