IRBPF-SLAM Algorithm for Intelligent Resampling of a Mobile Robots
-
摘要: 为了提高激光SLAM技术的建图精度,本文提出了一种智能重采样的IRBPF-SLAM算法,算法采用BAT启发式自适应重采样,对小颗粒进行重采样,产生新的解决方案,随机选择最佳解决方案,更新蝙蝠数量,将粒子归一化,优化的机器人状态更新,最后进行粒子重置,其迭代时间可以根据滤波器发散的程度进行自适应调整。此外,将激光传感器改进提议分布融合到算法中,以获得更好的提议分布和建图结果。仿真结果表明,所提出的IRBPF具有更好的准确性、计算效率和滤波一致性。在大型室内空间中,将IRBPF-SALM算法融合到基于ROS为框架下,在阿克曼转向移动平台进行测试,测试结果表明了新方法比原始方法更具优势。
-
关键词:
- 智能重采样 /
- IRBPF-SLAM /
- 启发式 /
- 归一化 /
- 自适应调整
Abstract: In order to improve the drawing accuracy of laser SLAM technology, this paper proposed an IRBPF-SLAM algorithm for intelligent resampling. The algorithm uses the bat heuristic adaptive resampling to resample small particles, generate new solutions, randomly select the best solution, update the number of bats, normalize the particles, update the optimal state of the robot, and finally reset the particles. The iteration times of the algorithm can be adjusted adaptively according to the degree of filter divergence. In addition, the distribution of laser sensors improved in the paper is integrated into the algorithm to obtain better distribution and mapping results. Simulation results show that the IRBPF-SLAM algorithm has better accuracy, calculation efficiency and filter consistency. In a large indoor space, the IRBPF-SLAM algorithm is integrated into the framework of ROS, and tested on the Ackerman mobile platform. The test results show that the new algorithm has more advantages than other algorithms. -
表 1 算法参数解释
参数 数值 第i时刻蝙蝠初始响度$A_i^0$ 0.9 常数$\alpha ,\gamma $ 0.9 第i时刻蝙蝠初始心率$r_i^0$ 0.1 随机向量$\boldsymbol{\varepsilon}$ 0.001 频率范围$[ {{f_{\min }},{f_{\max }}} ]$ [0,1] 迭代时间范围$[ {{N_{\min }},{N_{\max }}} ]$ [3,10] 表 2 算法精度参数对比
算法 均值 方差 百米误差/cm 粒子数 RBPF-SLAM 0.823 0.567 170 1500 改进的IRBPF-SLAM 0.096 0.078 35 520 -
[1] 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 doi: 10.1109/TRO.2016.2624754 [2] BAILEY T, NIETO J, GUIVANT J, et al. Consistency of the EKF-SLAM algorithm[C]//2006 IEEE/RSJ International Conference on Intelligent Robots and Systems. Beijing: IEEE, 2006: 3562-3568 [3] 李久胜, 李永强, 周荻. 基于EKF的SLAM算法的一致性分析[J]. 计算机仿真, 2008, 25(6): 155-160 doi: 10.3969/j.issn.1006-9348.2008.06.040LI J S, LI Y Q, ZHOU D. Analysis of the consistency of EKF-based SLAM[J]. Computer Simulation, 2008, 25(6): 155-160 (in Chinese) doi: 10.3969/j.issn.1006-9348.2008.06.040 [4] THRUN S, FOX D, BURGARD W, et al. Robust Monte Carlo localization for mobile robots[J]. Artificial Intelligence, 2001, 128(1-2): 99-141 doi: 10.1016/S0004-3702(01)00069-8 [5] PEI F J, WU M, ZHANG S M. Distributed SLAM using improved particle filter for mobile robot localization[J]. The Scientific World Journal, 2014, 2014: 239531 [6] CHOI H D, PAK J M, LIM M T, et al. A Gaussian distributed resampling algorithm for mitigation of sample impoverishment in particle filters[J]. International Journal of Control, Automation and Systems, 2015, 13(4): 1032-1036 doi: 10.1007/s12555-014-0355-2 [7] 许奇, 王华彬, 周健, 等. 用于目标跟踪的智能群体优化滤波算法[J]. 智能系统学报, 2019, 14(4): 697-707XU Q, WANG H B, ZHOU J, et al. Swarm intelligence filtering for robust object tracking[J]. CAAI Transactions on Intelligent Systems, 2019, 14(4): 697-707 (in Chinese) [8] 伍永健, 陈跃东, 陈孟元. 量子粒子群优化下的RBPF-SLAM算法研究[J]. 智能系统学报, 2018, 13(5): 829-835WU Y J, CHEN Y D, CHEN M Y. Research on RBPF-SLAM algorithm based on quantum-behaved particle swarm optimization[J]. CAAI Transactions on Intelligent Systems, 2018, 13(5): 829-835 (in Chinese) [9] MONTEMERLO M, THRUN S, ROLLER D, et al. FastSLAM 2.0: an improved particle filtering algorithm for simultaneous localization and mapping that provably converges[C]//Proceedings of the 18th International Joint Conference on Artificial Intelligence. San Francisco: Morgan Kaufmann Publishers Inc, 2003: 1151-1156 [10] MONTEMERLO M, THRUN S, KOLLER D, et al. FastSLAM: a factored solution to the simultaneous localization and mapping problem[C]//Eighteenth National Conference on Artificial Intelligence. Menlo Park: ACM, 2002: 593-598 [11] 胡文超, 孙新柱, 陈孟元. 音频感知哈希闭环检测的无人机仿生声呐SLAM算法研究[J]. 智能系统学报, 2019, 14(2): 338-345HU W C, SUN X Z, CHEN M Y. Research on BATSLAM algorithm for UAV based on audio perceptual hash closed-loop detection[J]. CAAI Transactions on Intelligent Systems, 2019, 14(2): 338-345 (in Chinese) [12] 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 doi: 10.1109/TRO.2006.889486 [13] LIN M W, YANG C J, LI D J, et al. Intelligent filter-based SLAM for mobile robots with improved localization performance[J]. IEEE Access, 2019, 7: 113284-113297 doi: 10.1109/ACCESS.2019.2934995 [14] GRISETTIYZ G, STACHNISS C, BURGARD W. Improving grid-based SLAM with rao-blackwellized particle filters by adaptive proposals and selective resampling[C]//Proceedings of the 2005 IEEE International Conference on Robotics and Automation. Barcelona: IEEE, 2005: 2432-2437 [15] 胡春旭, 熊枭, 任慰, 等. 基于嵌入式系统的室内移动机器人定位与导航[J]. 华中科技大学学报, 2013, 41(S1): 254-257, 266HU C X, XIONG X, REN W, et al. Localization and navigation for indoor mobile robot on embedded system[J]. Journal of Huazhong University of Science and Technology, 2013, 41(S1): 254-257, 266 (in Chinese) [16] GERKEY B. Slam_gmapping[EB/OL]. (2017-08-15)[2010-08-05]. http://wiki.ros.org/slam_gmapping [17] YIN S, ZHU X P. Intelligent particle filter and its application to fault detection of nonlinear system[J]. IEEE Transactions on Industrial Electronics, 2015, 62(6): 3852-3861 [18] PAK J M, AHN C K, SHMALIY Y S, et al. Improving reliability of particle filter-based localization in wireless sensor networks via hybrid particle/FIR filtering[J]. IEEE Transactions on Industrial Informatics, 2015, 11(5): 1089-1098 doi: 10.1109/TII.2015.2462771 [19] THALLAS A G, TSARDOULIAS E G, PETROU L. Topological based scan matching-odometry posterior sampling in RBPF under kinematic model failures[J]. Journal of Intelligent & Robotic Systems, 2017, 91(3): 543-568 [20] 张建伟, 张立新, 胡颖, 等. 开源机器人操作系统: ROS[M]. 北京: 科学出版社, 2012: 1-6ZHANG J W, ZHANG L X, HU Y, et al. Open source robot operating system[M]. Beijing: Science Press, 2012: 1-6 (in Chinese)