史鹏程, 李加元, 刘欣怡, 张永军. 基于室内圆柱的激光雷达全局定位与回环检测[J]. 武汉大学学报 ( 信息科学版). DOI: 10.13203/j.whugis20220761
引用本文: 史鹏程, 李加元, 刘欣怡, 张永军. 基于室内圆柱的激光雷达全局定位与回环检测[J]. 武汉大学学报 ( 信息科学版). DOI: 10.13203/j.whugis20220761
SHI Pengcheng, LI Jiayuan, LIU Xinyi, ZHANG Yongjun. LiDAR Global Localization and Loop Closure Detection Based on Indoor Cylinders[J]. Geomatics and Information Science of Wuhan University. DOI: 10.13203/j.whugis20220761
Citation: SHI Pengcheng, LI Jiayuan, LIU Xinyi, ZHANG Yongjun. LiDAR Global Localization and Loop Closure Detection Based on Indoor Cylinders[J]. Geomatics and Information Science of Wuhan University. DOI: 10.13203/j.whugis20220761

基于室内圆柱的激光雷达全局定位与回环检测

LiDAR Global Localization and Loop Closure Detection Based on Indoor Cylinders

  • 摘要: 针对移动机器人在大范围室内环境的定位难题,提出一种基于圆柱特征的全局定位方法。首先,设计一种参数化地图,采用随机采样一致性算法和几何模型分割出地图中的圆柱点云,利用栅格地图描述环境中稳定人工构筑物的分布。其次,采用轻量级二进制文件记录圆柱和地物分布。然后,基于圆柱独特的几何特性(离群性、对称性和显著性),提出一种实时LiDAR点云圆柱分割方法。最后,设计两种位姿求解策略,第一种是启发式搜索,在地图与实时数据中搜索出最佳匹配圆柱,进而分别解算平移量和旋转量。第二种是优化求解,利用圆柱之间拓扑关系,构建约束条件并计算最优位姿。为验证本文方法可行性,采用16线激光雷达在大厅、走廊及混合场景三种典型室内环境进行全局定位和回环检测实验。试验结果表明,该方法可有效实现典型空旷室内环境中机器人的全局定位,可达到90%的定位成功率以及0.088m定位误差,部分数据可达到毫米级定位精度,最快速度在100ms内,位置识别性能达到主流方法水平。该方法基本满足实际应用中自动驾驶对全局定位的精度和效率要求。

     

    Abstract: Objectives: Localization is an important module of the LiDAR SLAM system, which provides basic information for perception, control, and planning, further assisting robots to accomplish higher-level tasks. However, LiDAR localization methods still face some problems:the localization accuracy and efficiency cannot meet the requirements of the robot products. In some textureless or large open environments, the lack of features easily leads to dangerous robot kidnappings. Consequently, aiming at the localization problems of mobile robots in large indoor environments, a global localization method based on cylindrical features is proposed. Methods: Firstly, an offline parameterized map is designed, which consists of some map cylinders and a raster map. Because the point cloud map contains a large number of 3D points and complete cylinders, random sample consensus (RANSAC) and geometric models are combined to directly segment the cylindrical points. The raster map is employed to describe the distributions of stable artificial structures. Then, some lightweight binary files are used to offline record the geometric model of cylinders and the feature distribution of the map. Next, based on three unique geometric characteristics of the cylinder (outlier, symmetry, and saliency), a real-time LiDAR point cloud cylinder segmentation method is proposed. Finally, two pose computation strategies are designed. The first is an optimization model based on heuristic search, which searches for the best matching cylinder between the map and real-time point cloud, and calculates the translation and rotation, respectively. The second is an optimization model based on multicylinder constraints, which employs both the topological relation (point-to-point and point-to-line constraints) and geometry attributes to find approximately congruent cylinders, then computes optimal pose. Results: To verify the feasibility of the proposed method, we use a 16-line LiDAR to collect the experimental data in three real-world indoor environments, i.e., lobby, corridor, and hybrid scenarios. The global localization experiment is compared to a similar wall-based localization method, and the loop closure detection is compared to M2DP, ESF, Scan Context, and the wall-based localization. The experimental results show that the proposed method outperforms the baseline methods. The place recognition and localization performance of the proposed method reach the mainstream method level, with a localization success rate of 90% and an error of 0.088m. Some data can reach millimeter localization accuracy, and the fastest speed is within 100ms. Conclusions: The proposed method can effectively realize the global localization and place recognition of the robots in typical open indoor environments. It meets the accuracy and efficiency requirements of autonomous driving for global localization in practical applications. It can be applied to solve the problems of position initialization, re-localization, and loop closure detection.

     

/

返回文章
返回