動的制御バリア関数に基づくモデル予測制御による移動ロボットの安全クリティカルな障害物回避
Dynamic Control Barrier Function-based Model Predictive Control to Safety-Critical Obstacle-Avoidance of Mobile Robot
LiDAR点群から障害物を検出・追跡し、動的制御バリア関数とモデル予測制御を組み合わせて移動ロボットの安全な動的障害物回避を実現した。
著者: Zhuozhu Jian, Zihong Yan, Xuanang Lei, Zihong Lu, Bin Lan, Xueqian Wang, Bin Liang
分類: cs.RO
原文アブストラクト
This paper presents an efficient and safe method to avoid static and dynamic obstacles based on LiDAR. First, point cloud is used to generate a real-time local grid map for obstacle detection. Then, obstacles are clustered by DBSCAN algorithm and enclosed with minimum bounding ellipses (MBEs). In addition, data association is conducted to match each MBE with the obstacle in the current frame. Considering MBE as an observation, Kalman filter (KF) is used to estimate and predict the motion state of the obstacle. In this way, the trajectory of each obstacle in the forward time domain can be parameterized as a set of ellipses. Due to the uncertainty of the MBE, the semi-major and semi-minor axes of the parameterized ellipse are extended to ensure safety. We extend the traditional Control Barrier Function (CBF) and propose Dynamic Control Barrier Function (D-CBF). We combine D-CBF with Model Predictive Control (MPC) to implement safety-critical dynamic obstacle avoidance. Experiments in simulated and real scenarios are conducted to verify the effectiveness of our algorithm. The source code is released for the reference of the community.
関連論文
- CNNベースのセンサフュージョンによる移動ロボットのリアルタイム障害物回避移動ロボット/障害物回避
- 時変制御バリア関数による一輪車モデル移動ロボットの障害物回避移動ロボット/障害物回避
