面向未知环境的紧耦合激光SLAM方法

Tightly coupled LiDAR SLAM method for unknown environment

  • 摘要: 针对传统激光SLAM在长走廊、隧道等退化环境下系统精度低或算法失效,且存在常规环境下回环检测稳健性差等问题,提出一种面向未知环境的紧耦合激光SLAM方法。首先,采用紧耦合框架,融合LiDAR与IMU信息,修正IMU零偏,为LiDAR里程计提供高精度先验信息;其次,计算LiDAR里程计雅克比矩阵,实时检测环境几何信息维度,融合轮式里程计与IMU数据,补偿LiDAR里程计自由度;最后,构建变阈值回环搜索模型,采用不同配准方法分析对应阈值的关键帧信息,提高回环检测召回率。长走廊环境中,所提方法定位误差较A-LOAM、LIO-SAM分别降低了91.04%和97.37%;常规环境中,在满足回环检测准确率为100%的条件下,所提方法召回率较LIO-SAM提高了35%。实验结果表明,所提方法具有较高的鲁棒性与定位精度。

     

    Abstract:
      Objective  Three-dimensional lidar is widely used in simultaneous localization and mapping (SLAM) research due to its accurate and reliable measurement performance, and has achieved fruitful results. However, in the scene where the geometric features such as long corridors and tunnels are not rich enough, the point cloud registration will have an additional degree of freedom in one direction, and the laser SLAM based on the point cloud information will degenerate, resulting in the failure of robot positioning and mapping, which will lead to the failure of subsequent navigation tasks. That is to say, when moving along a long corridor, the laser point cloud obtained is the same, which makes the matching algorithm unable to accurately estimate the motion in this direction. And in the conventional environment, the accumulated error of the front-end odometer increases with the increase of the scene. The loopback detection method based on the Euclidean distance of the traditional laser SLAM algorithm has the problem of missing detection and cannot eliminate the accumulated error of the front-end odometer. For this reason, a close-coupled laser SLAM method for an unknown environment is proposed in this paper.
      Methods  First of all, a close-coupled framework (Fig.1) is used to fuse LiDAR and IMU information, correct IMU bias, and provide high-precision prior information for the LiDAR odometer. Secondly, the LiDAR odometer Jacobi matrix is calculated, the environmental geometric information dimension is detected in real-time, the wheel odometer and IMU data is integrated, and the freedom of LiDAR odometer is compensated. Finally, in view of the loopback detection method based on Euclidean distance that has missed detection due to the accumulated error of the odometer (Fig.2), a variable-threshold loopback search model is constructed, and the corresponding threshold key frame information is analyzed by different registration methods to improve the loopback detection recall rate (Fig.3).
      Results and Discussions   A-LOAM, LIO-SAM and the method in this paper are used to test in a 76.78 m long and 1.85 m wide corridor respectively. The corridor is flanked by large white walls, with high scene repetition and fewer geometric features in the direction of motion. In the long corridor degradation scenario, the scene restoration degree of the method in this paper reaches 99.71%, and the odometer drift is reduced to 0.12 m, which is 91.04% and 97.37% lower than A-LOAM and LIO-SAM, respectively (Tab.1). In addition, the data sets with three drift thresholds are selected, and 20 data sets are selected for each threshold to test the loopback detection performance. Under the condition that the accuracy of loopback detection is 100%, the recall rate of loopback detection is 98.3%, which is 35% higher than that of the LIO-SAM algorithm on average (Tab.3).
      Conclusions  In this study, a close-coupled laser SLAM method for an unknown environment is proposed. This method uses a tight coupling framework to improve the efficiency of sensor information utilization, and can detect the geometric information dimension of the environment in real-time. In the environment of fast-rotating scenes and missing geometric information, it can still achieve high-precision positioning and mapping. A variable threshold loopback search model is builded, which can maintain a high loopback detection recall rate in large scenes. The position and posture of historical frames are corrected, and the global consistency of the map is ensured. The proposed method is proved to be robust and accurate by many scene experiments.

     

/

返回文章
返回