ScanContext算法流程-基于激光雷达的回环检测（配合论文看）
·
论文信息
算法总体流程图
1 构建SC（Description）
1.1 将单帧点云按如下分区方式降维为2d图像，每个图像的像素值为对应分区的最高点的z轴值。
每一个环称为一个 ring, 其数量为N_r，每一个扇形为一个sector,其数量为N_s
1.2统计每个ring中的有点的sector的个数占总sector的个数，并以此生成索引向量。（见2.1）
1.3 两个SC之间的相似度评分计算方式：
1.4 旋转导致的SC列的位置变化的处理：
平移候选帧SC的一列，与当前帧SC计算相似度，并重复上述操作，取其中最小的分数为最终的相似得分。实际代码并未这样做，因为时间复杂度很高。实际代码是将SC降为一维的向量，平移计算求最小得分附近的几帧再进行SC之间的相似度计算取最小的。
2 两阶段查找算法
2.1 第一阶段
1.2中的索引向量，生成方式如下图：
利用计算得到的k作为key构建KD-tree
2.2 第二阶段
利用查询帧的k在KD-tree里查找，找到一定数量的候选帧后，在候选帧组里利用式6计算每个候选帧的分数后，选取得分最小且小于阈值的为回环帧。
其中：c*即为计算得到的回环候选帧
北京人形旗下天工造物具身智能开源社区，聚焦具身天工与慧思开物两大平台
更多推荐
0
0- 0
已为社区贡献2条内容
所有评论(0)