论文摘要指出,为了在长期变化的环境中准确进行定位,提出了一种新型的长期视觉SLAM(同步定位与地图构建)系统,该系统具备地图预测和动态物体移除功能。系统首先设计了一个高效的视觉点云匹配算法,将2D像素信息和3D体素信息有效融合。其次,使用贝叶斯持久性过滤器对地图点进行静态、半静态和动态分类,并移除动态点以消除其影响。通过对半静态地图点的时间序列建模,可以获得全局预测地图。最后,将预测的全局地图整合到先进的SLAM方法中,从而实现了一种适用于长期动态环境的高效视觉SLAM系统。通过在室内环境中对轮椅机器人进行数月的广泛实验,结果表明该方法在地图预测精度和定位性能方面优于现有方法。
论文中实现的算法过程主要包括以下几个步骤:
-
视觉点云匹配算法:设计一个算法来高效地融合2D像素信息和3D体素信息。
-
地图点分类:使用贝叶斯持久性过滤器(BPF)将每个地图点分类为静态、半静态和动态。
-
动态地图点移除:移除动态地图点以消除它们对地图的影响。
-
全局预测地图:通过对半静态地图点的时间序列建模来获得一个全局预测地图。
-
系统集成:将预测的全局地图整合到现有的SLAM方法中,以提高长期动态环境下视觉SLAM系统的效率。
-
实验验证:通过在室内环境中对轮椅机器人进行数月的实验,验证了方法的有效性,并展示了该方法在地图预测精度和定位性能方面相较现有方法的优越性。
此外,论文还提出了一种基于长短期指数模型的预测方法,以更准确地预测半静态地图点的未来状态,并定义了一个新的3D地图点描述符,用于在不同时间序列的地图中匹配地图点。通过贝叶斯持久性过滤和生存分析,可以计算每个地图点在时间序列中的生存函数,并据此预测其未来状态。
根据文中描述,动态地图点的移除过程如下:
-
使用贝叶斯持久性过滤器(Bayesian Persistence Filter,BPF)对每个地图点进行分类,将它们分为静态、半静态和动态。
-
识别出的动态地图点通常是在单次机器人遍历的短时间内出现并快速移动的,例如周围移动的人类。
-
动态地图点的移除是为了消除这些点对地图的影响,这样做可以通过多次访问同一地点来检测到并移除这些点。
-
文章中提出的系统使用BPF来移除环境中的动态地图点。首先,通过追踪每个地图点的观察情况来准确使用持久性过滤器。
-
在追踪观察模块中,可以追踪相应地图点的所有观察情况来更新持久性过滤器。当新的帧到达时,将当前帧中的关键点与候选地图点匹配。
-
如果地图点匹配,则在此时间戳中被定义为存活,并将"命中观察"分配给持久性过滤器。否则,地图点被定义为在此时间戳中死亡,并将"未命中观察"分配给持久性过滤器。
-
对于持久性概率低于某一阈值的地图点,将其视为动态地图点并从地图中移除。
-
如果一个地图点在多个帧中都没有被观察到,就不能立即定义为动态地图点。每个地图点与观察它的关键帧中的一些关键点相对应。当移除一个地图点时,将相应的关键点设置为"不可用"。
通过以上步骤,系统能够有效地移除影响地图准确性的动态地图点,从而提高了SLAM系统在长期动态环境下的表现。
论文中将预测的全局地图整合到现有SLAM方法中的过程主要包括以下几个步骤:
-
局部地图构建:使用局部地图构建线程获取环境的精确地图。
-
地图整合:依照ORB-SLAM3方法,将局部地图合并入全局地图中。这一步骤确保了在动态环境中对地图进行持续更新。
-
重定位算法:使用重定位算法来获取对应的光度信息,并利用迭代最近点(Iterative Closest Point,ICP)算法得到匹配的地图点云,这是为了在不同的会话之间获取准确的机器人初始位置。
-
定位性能评估:通过在不同速度下收集的测试数据集来评估定位性能。这些数据集在Github上开源,以便社区使用和验证。
-
真实世界数据集的地面真实值获取:使用3D激光雷达和激光雷达惯性里程计平滑和映射(LIO-SAM)方法获取。
通过上述步骤,研究者们成功地将时间序列建模和全局地图预测整合到了现有的SLAM框架中,提高了在长期动态环境下的定位和地图构建性能。实验结果表明,该系统在定位准确性、鲁棒性和内存消耗方面都达到了较好的效果。
在论文中,评定算法性能的方法包括以下几个主要方面:
-
绝对轨迹误差(ATE): ATE用于评估算法预测的轨迹和实际轨迹之间的差异。这是一个常用的衡量SLAM系统定位准确性的指标。
-
动态环境下的性能: 评估算法在处理动态环境,尤其是在移动物体和长期环境变化方面的能力。
-
内存消耗: 衡量算法运行时对内存的需求。对于长期运行的系统,内存效率是一个重要指标。
-
实验验证: 通过在不同环境和条件下进行的实验来评估算法的性能。这些实验通常包括在真实世界数据集和模拟数据集上的测试。
-
与现有方法的比较: 将所提算法的性能与其他现有SLAM方法进行比较,以展示其相对优势和缺点。
-
正确率(CR): 评估系统在整个数据期间的稳健性。这是基于每个估计位姿的绝对轨迹误差和绝对方向误差来计算的。
通过这些评估方法,作者展示了他们提出的系统在长期动态环境下的有效性和优势,特别是在地图预测精度、定位性能和对动态物体处理方面。
论文的主要创新点包括:
-
长期视觉SLAM系统:提出了一种结合贝叶斯持久性过滤器和全局地图预测的长期视觉SLAM系统,适用于长时间、动态变化的环境中。
-
贝叶斯持久性过滤器(BPF):利用BPF对地图点进行静态、半静态和动态分类,以及有效地移除动态地图点,减少它们对地图准确性的影响。
-
全局地图预测:通过对半静态地图点的时间序列建模,实现了对环境的长期、动态变化的有效预测。
-
融合视觉点云匹配算法:开发了一种新型的视觉点云匹配算法,结合2D像素信息和3D体素信息,以提高匹配的精确度。
-
实验验证:通过在实际室内环境中对轮椅机器人进行长期实验,证明了方法的有效性,并与现有方法进行了比较,展示了其在地图预测精度和定位性能方面的优势。
这些创新点表明了该研究在长期动态环境中视觉SLAM系统的发展方面取得了重要进步。
在论文中,作者将提出的算法与以下现有的SLAM方法进行了比较:
-
ORB-SLAM2:一种广泛使用的基于特征的SLAM方法,适用于单目、双目和RGB-D相机。
-
ORB-SLAM3:ORB-SLAM的最新版本,支持视觉、视觉-惯性和多地图SLAM。
-
DVO SLAM:基于稠密视觉里程计(Dense Visual Odometry)的SLAM方法。
-
Depth-Edge SLAM:一种利用深度和边缘信息进行SLAM的方法。
-
DynaSLAM:针对动态环境设计的一种SLAM系统,能够在存在动态物体的环境中进行地图构建和定位。
-
其他变体:包括没有运动物体移除(MPR)、没有全局地图预测(GMP)、没有动态物体检测(OD)、没有3D匹配等方法的LTVS-BPF变体。
这些对比方法覆盖了不同类型的SLAM系统,包括基于特征、基于深度、以及针对动态环境的方法。通过与这些方法的比较,论文能够展示所提出系统在不同情境下的性能优势和适用性。