一种基于激光雷达的矿井环境下自动驾驶定位的快速回环检测方法
摘要:
本发明公开了一种基于激光雷达的矿井环境下自动驾驶定位的快速回环检测方法。该方法将激光雷达的点云首先进行区域限制,进行直通滤波,之后在俯瞰图的视角下进行空间的网格划分,再在每个网格中进行点云高度累积,超过一定阈值的点云进行保留;其次,将处理后的点云根据环形和扇形的分区进行点云平均高度的记录,保存成为二维的矩阵,形成单帧激光雷达的描述子,再利用每个环形区域的编码值构建kd树实现快速检索,将候选帧与当前帧的描述子进行相似度计算,得到最佳匹配完成回环检测。本方法利用障碍物的点云特征进行回环检测,本发明解决了现有的激光雷达回环检测方法面对矿井场景下出现大量假阳性的问题,可以实现在具有隧道顶部和坡度变化大的场景下有效准确的回环检测。本方法可以无缝接入ros系统,利用numba加速以后能够实时处理点云数据,具有较高的潜在的商业价值。
0/0