Adaptive High-Order Control Barrier Function-Based Iterative LQR for Real Time Safety-Critical Motion Planning
- 8 May 2024
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Robotics and Automation Letters
- Vol. 9 (7) , 6099-6106
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.Keywords
Funding Information
- National Natural Science Foundation of China (61720106010, 61836001, 62173035, 62373049)
- Natural Science Foundation of Beijing Municipality (4222052)
This publication has 27 references indexed in Scilit:
- Control Barrier Functions for Systems with High Relative Degree2019
- Differential dynamic programming with nonlinear constraints2017
- Algorithmic safety measures for intelligent industrial co-robots2016
- Control barrier function based quadratic programs with application to adaptive cruise control2014
- Control-limited differential dynamic programming2014
- A Barrier Function Method for the Optimization of Trajectory Functionals with Constraints2006
- Convex Optimization2004
- Differential dynamic programming technique for optimal controlOptimal Control Applications and Methods, 1994
- Convergence in unconstrained discrete-time differential dynamic programmingIEEE Transactions on Automatic Control, 1991
- A Second-order Gradient Method for Determining Optimal Trajectories of Non-linear Discrete-time SystemsInternational Journal of Control, 1966