解决视觉定位漂移导致的导航危险,确保地图始终安全可靠。
Certifiably-Correct Mapping for Safe Navigation Despite Odometry Drift
- 基于增量位姿误差缩小安全区域,动态修正地图
- 仿真与实测均避免碰撞,真实机器人可提前停止
- 适用于无人机、火星车等对安全要求高的场景
精准感知、状态估计与建图是机器人安全导航的基础,因规划与控制依赖这些模块做出关键决策。然而现有建图方法常假设位姿估计完全准确,这一不现实假设可能导致障碍物地图错误,引发碰撞。本文提出一种可验证正确的建图框架,确保在基于视觉的定位系统(VIO/SLAM)存在里程计漂移时,障碍物地图仍能正确识别无障区域。通过在每个时间步基于增量位姿误差对安全区域进行收缩,即使整体位姿误差相对于惯性系无界增长,仍能保证机器人周围的局部地图准确可靠。本文提出两种改进主流建图范式的方法:(I) 安全飞行走廊,(II) 有符号距离场。形式化证明了两种方法的正确性,并说明其如何与现有规划与控制模块集成。使用Replica数据集的仿真表明,本方法优于当前最优技术。真实世界中,搭载机器人的探测车实验显示,基线方法会撞上已知障碍物,而本文框架使探测车能在潜在碰撞前安全停止。
原文摘要 · Abstract (English)
Accurate perception, state estimation and mapping are essential for safe robotic navigation as planners and controllers rely on these components for safety-critical decisions. However, existing mapping approaches often assume perfect pose estimates, an unrealistic assumption that can lead to incorrect obstacle maps and therefore collisions. This paper introduces a framework for certifiably-correct mapping that ensures that the obstacle map correctly classifies obstacle-free regions despite the odometry drift in vision-based localization systems (VIO}/SLAM). By deflating the safe region based on the incremental odometry error at each timestep, we ensure that the map remains accurate and reliable locally around the robot, even as the overall odometry error with respect to the inertial frame grows unbounded. Our contributions include two approaches to modify popular obstacle mapping paradigms, (I) Safe Flight Corridors, and (II) Signed Distance Fields. We formally prove the correctness of both methods, and describe how they integrate with existing planning and control modules. Simulations using the Replica dataset highlight the efficacy of our methods compared to state-of-the-art techniques. Real-world experiments with a robotic rover show that, while baseline methods result in collisions with previously mapped obstacles, the proposed framework enables the rover to safely stop before potential collisions.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。