激光SLAM 回环检测---STD(A Stable Triangle Descriptor for 3D place recognition)

**前言:**之前使用基于scan context方法实现重定位;但是在高动态场景,仍需要手动重定位。

摘要

本文提出了一种新的三维位置识别全局描述子------稳定三角形描述子(Stable Triangle Descriptor,STD)。对于任意一个三角形,其形状可由边长或内角唯一确定,并且三角形的形状在刚体变换下保持完全不变。基于这一特性,本文首先设计了一种高效的三维点云局部关键点提取方法,并将这些关键点编码为三角形描述子。随后,通过匹配不同点云中三角形描述子的边长(及其他辅助信息)实现位置识别。由描述子匹配得到的点对应关系还可进一步用于几何一致性验证,从而显著提升位置识别的准确性。

本文的主要贡献总结如下:

  • 提出了一种三角形描述子,其为一个六维向量,包含三条边的长度以及与每个三角形顶点相邻平面法向量之间的夹角。该描述子在保持高度判别性的同时,对旋转和平移具有完全不变性。
  • 提出了一种基于关键帧的快速关键点提取方法。通过将点云投影至平面边界并提取结构关键点,以有效刻画场景的几何结构,并利用相邻关键点构建三角形描述子。
  • 在多种场景和多类型 LiDAR 数据上进行了充分验证,包括城市环境、室内环境以及非结构化场景,同时涵盖传统旋转式 LiDAR 和固态 LiDAR。大量实验结果验证了所提方法的有效性和鲁棒性。

主要方法

本文方法首先从关键帧中计算稳定三角形描述子,并利用哈希表构建描述子数据库,以实现高效的存储与匹配。在回环检测阶段,根据描述子匹配得分选取匹配度最高的前 10 帧作为回环候选帧。当候选帧通过几何一致性验证后,即被判定为有效回环,同时可估计当前帧与回环帧之间的相对位姿变换。

稳定三角形描述子(Stable Triangle Descriptor)

回环候选帧搜索(Search of Loop Candidates)

备注 1: 由于边界关键点是从三维点云中提取的平面上进行投影,而非从距离图像中提取,因此所获得的关键点对视角变化具有不变性。此外,所采用的六个描述子属性均对任意刚体变换保持不变性,从而使得整体方法同时具备旋转和平移不变性。

备注 2: 得益于三角形边长的有序排列以及三角形本身的几何稳定性,若且仅若两个三角形的有序边长完全相等,则可判定这两个三角形相同,而无需枚举不同边之间的对应关系。

回环检测(Loop Detection)

对于每一个回环候选关键帧,我们首先进行几何一致性验证,以剔除因描述子匹配错误导致的虚假回环。

相关推荐
加油JIAX20 小时前
IMU预积分(VINS)
slam·imu·预积分·vins
加油JIAX1 天前
贝叶斯滤波与卡尔曼滤波
概率论·slam·kf
kobesdu2 天前
FAST-LIO2 + 蓝海M300激光雷达:从建图到实时栅格图的完整流程
算法·机器人·ros·slam·fast lio
bryant_meng3 天前
【SLAM】Map Folding
计算机视觉·map·slam·激光雷达·回环检测
kobesdu4 天前
综合强度信息的激光雷达去拖尾算法解析和源码实现
算法·机器人·ros·slam·激光雷达
加油JIAX4 天前
误差状态卡尔曼滤波(ESKF)推导
概率论·slam·ekf·imu·卡尔曼滤波·kf·eskf
胡摩西7 天前
当大模型遇上毫米级定位:机器人将拥有“空间思维”?
人工智能·机器人·slam·gps·室内定位·roomaps
胡摩西17 天前
制造业室内精准定位:毫米级技术如何破解工厂自动化“最后一厘米”难题
人工智能·自动化·slam·室内定位·roomaps
冰水不凉20 天前
cartographer源码阅读四-MapBuilder
学习·slam
躺不平的小刘24 天前
视觉SLAM十四讲:全攻略 —— 逻辑脉络、学习路线与Ubuntu 18.04实践准备
linux·学习·ubuntu·slam