Research on Improved Laser SLAM Algorithm for Mobile Robots

doi:10.3778/j.issn.1002-8331.2009-0264

Abstract

Abstract: Aiming at the problems of traditional RBPF（Rao-Blackwellised particle filter） algorithm with low positioning accuracy, particle degradation, and loss of particle diversity, an improved SLAM（simultaneous localization and mapping） algorithm based on lidar is proposed. Firstly, the principal component analysis method is used to coarsely register the point clouds between adjacent frames, and then the improved point-to-line iterative nearest point registration algorithm is used to correct the coarse registration results to complete the precise registration. In the improved resampling algorithm, a small-weight particle set is introduced when the large-weight particle set is copied multiple times, which improves the lack of particle diversity and improves the positioning accuracy of the mobile robot. Finally, the improved algorithm is applied to the Turtlebot robot. The test results show that the improved SLAM algorithm based on lidar in this paper is better than the traditional algorithm in terms of positioning accuracy and mapping accuracy.

Key words: mobile robot, simultaneous localization and mapping（SLAM）, point cloud registration, particle filtering, resampling, robot operating system（ROS）

摘要： 针对传统RBPF（Rao-Blackwellised particle filter）算法存在定位精度低、粒子退化、粒子多样性丧失的问题，提出了一种基于激光雷达的改进SLAM（simultaneous localization and mapping）算法。首先基于主成分分析法对相邻帧的点云进行粗配准，再采用改进点到线迭代最近点配准算法校正粗配准结果完成精确配准。改进重采样算法中，在多次复制大权重粒子集合的情况下引入小权重粒子集合，改善粒子多样性缺乏问题，提高了移动机器人定位精度。最后将改进算法应用于Turtlebot机器人，实验结果表明，改进的基于激光雷达的SLAM算法在定位精度和建图准确度方面相比于传统算法效果更好。

关键词: 移动机器人, 同步定位与地图构建（SLAM）, 点云配准, 粒子滤波, 重采样, 机器人操作系统（ROS）

CHEN Dan, WU Xin. Research on Improved Laser SLAM Algorithm for Mobile Robots[J]. Computer Engineering and Applications, 2022, 58(4): 163-168.

陈丹, 吴欣. 移动机器人改进激光SLAM算法研究[J]. 计算机工程与应用, 2022, 58(4): 163-168.

References

[1] IOZUKA S，NAKAMURA T，SUZUKI S.Robot navigation in dynamic environment using navigation function APF with SLAM[C]//2014 10th France-Japan 8th Europe-Asia Congress on Mecatronics，Tokyo，Nov 27-29，2014：89-92.
[2] THRUN S，LEONARD J J.Simultaneous localization and mapping[J].IEEE Transactions on Intelligent Transportation Systems，2015，13（2）：541-552.
[3] CADENA C，CARLONE L，CARRILLO H，et al.Past，present，and future of simultaneous localization and mapping：toward the robust-perception age[J].IEEE Transactions on Robotics，2016，32（6）：1309-1332.
[4] WONGSUWAN K，SUKVICHAI K.Generalizing corrective gradient refinement in RBPF for occupancy grid lidar SLAM[C]//2017 IEEE International Conference on Robotics and Biomimetics，Macau，China，Dec 5-8，2017：495-500.
[5] JO H，CHO H M，JO S，et al.Efficient grid-based Rao-Blackwellized particle filter SLAM with interparticle map sharing[J].IEEE ASME Transactions on Mechatronics，2018，23（2）：714-724.
[6] 杨爽，曾碧，何炜婷.融合语义激光与地标信息的SLAM技术研究[J].计算机工程与应用，2020，56（18）：262-271.
YANG S，ZENG B，HE W T.Research on SLAM technology combining semantic laser and landmark information[J].Computer Engineering and Applications，2020，56（18）：262-271.
[7] LI T C，BOLIC M，DJURIC P M.Resampling methods for particle filtering：classification，implementation，and strategies[J].IEEE Signal Processing Magazine，2015，32（3）：70-86.
[8] MURPHY K，RUSELL S.Rao-Blackwellised particle filtering for dynamic Bayesian networks[M]//Sequential Monte Carlo methods in practice.New York：Springer，2001：499-515.
[9] GRISETTI G，STACHNISS C，BURGARD W.Improved techniques for grid mapping with Rao-Blackwellized particle filters[J].IEEE Transactions on Robotics，2007，23（1）：34-46.
[10] 田梦楚，薄煜明，陈志敏，等.萤火虫算法智能优化粒子滤波[J].自动化学报，2016，42（1）：89-97.
TIAN M C，BO Y M，CHEN Z M，et al.Firefly algorithm intelligent optimization particle filter[J].Acta Automatica Sinica，2016，42（1）：89-97.
[11] 刘云涛.基于蝴蝶优化的粒子滤波算法[J].信息技术与网络安全，2018，37（7）：37-41.
LIU Y T.Particle filter algorithm based on butterfly optimization[J].Information Technology and Network Security，2018，37（7）：37-41.
[12] 吴正越，张超，林岩.基于RBPF的激光SLAM算法优化设计[J].计算机工程，2020，46（7）：294-299.
WU Z Y，ZHANG C，LIN Y.Optimal design of laser SLAM algorithm based on RBPF[J].Computer Engineering，2020，46（7）：294-299.
[13] 王彦，张鹏超，姚晋晋，等.基于重采样技术的激光SLAM系统优化设计[J].中国科技论文，2020，15（1）：125-130.
WANG Y，ZHANG P C，YAO J J，et al.Optimal design of laser SLAM system based on resampling technology[J].Chinese Science and Technology Paper，2020，15（1）：125-130.
[14] LEE B，LEE D D.Learning anisotropic ICP（LA-ICP） for robust and efficient 3D registration[C]//2016 IEEE International Conference on Robotics and Automation，Stockholm，May 16-21，2016：5040-5045.
[15] GUAN W，LI W，REN Y.Point cloud registration based on improved ICP algorithm[C]//2018 Chinese Control and Decision Conference，Shenyang，Jun 9-11，2018：1461-1465.
[16] WU Z Z，CHEN H C，DU S Y，et al.Correntropy based scale ICP algorithm for robust point set registration[J].Pattern Recognition，2019，93：14-24.
[17] FIROOZABAD A D，ABUTALEBI H R.Incorporating Gammatone filterbank and Welch spectral estimation in subband processing-based localization of multiple simultaneous speakers[J].Applied Acoustics，2017，125：147-165.
[18] ZHAO Y，WANG T，QIN W，et al.Improved Rao-Blackwellised particle filter based on randomly weighted particle swarm optimization[J].Computers & Electrical Engineering，2018，71：477-484.