用点云动态追踪实现机器人安全避障,实时预测障碍物运动轨迹。
Point Cloud-Based Control Barrier Functions for Model Predictive Control in Safety-Critical Navigation of Autonomous Mobile Robots
- 通过卡尔曼滤波分离并预测动态点云运动状态,构建未来时间域地图。
- 结合控制屏障函数与模型预测控制,实现对静动态障碍物的双重避障。
- 适用于复杂场景下高安全性要求的自主移动机器人导航任务。
本文提出一种新型运动规划算法,用于提升自主移动机器人的安全关键导航能力。算法集成实时动态障碍物追踪与建图系统,将点云数据分类为静态与动态成分;对动态点云使用卡尔曼滤波估计并预测其运动状态,进而外推未来状态,并与静态点云融合生成前向时间域(FTD)地图。基于碰撞检测识别的风险点,构建控制屏障函数(CBFs)约束,结合非线性模型预测控制,使机器人能有效规避静态与动态障碍物。仿真与真实场景实验均验证了该算法在复杂环境中的有效性。对比两种基线方法,本算法在避障安全性与鲁棒性方面表现更优。源代码已开源,供机器人社区参考。
原文摘要 · Abstract (English)
In this work, we propose a novel motion planning algorithm to facilitate safety-critical navigation for autonomous mobile robots. The proposed algorithm integrates a real-time dynamic obstacle tracking and mapping system that categorizes point clouds into dynamic and static components. For dynamic point clouds, the Kalman filter is employed to estimate and predict their motion states. Based on these predictions, we extrapolate the future states of dynamic point clouds, which are subsequently merged with static point clouds to construct the forward-time-domain (FTD) map. By combining control barrier functions (CBFs) with nonlinear model predictive control, the proposed algorithm enables the robot to effectively avoid both static and dynamic obstacles. The CBF constraints are formulated based on risk points identified through collision detection between the predicted future states and the FTD map. Experimental results from both simulated and real-world scenarios demonstrate the efficacy of the proposed algorithm in complex environments. In simulation experiments, the proposed algorithm is compared with two baseline approaches, showing superior performance in terms of safety and robustness in obstacle avoidance. The source code is released for the reference of the robotics community.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。