A Robust 2D Lidar SLAM Method in Complex Environment

Abstract

The two-dimensional (2D) lidar is a ranging optical sensor that can measure the cross-section of the geometric structure of the environment. We propose a robust 2D lidar simultaneous localization and mapping (SLAM) algorithm working in ambiguous environments. To improve the front-end scan-matching module’s accuracy and robustness, we propose performing degeneration analysis, line landmark tracking, and environment coverage analysis. The max-clique selection and odometer verification are introduced to increase the stability of the SLAM algorithm in an ambiguous environment. Moreover, we propose a tightly coupled framework that integrates lidar, wheel odometer, and inertial measurement unit (IMU). The framework achieves the accurate mapping in large-scale environments using a factor graph to model the multi-sensor fusion SLAM problem. The experimental results demonstrate that the proposed method achieves a highly accurate front-end scan-matching module with an error of 3.8% of the existing method. And it can run stably in ambiguous environments where the existing method will be failed. Moreover, it ccan successfully construct a map with an area of more than 250 000 square meters.

Keywords

Robotics / simultaneous localization and mapping / 2D lidar / multi-sensor fusion

References

[1] J. J. Leonard and H. F. Durrant-Whyte, “Simultaneous map building and localization for an autonomous mobile robot,” in IEEE International Conference on Intelligent Robots and Systems (IROS), Osaka, Japan, Nov. 1991, pp. 1442–1447.

[2] R. Smith, M. Self, and P. Cheeseman, “Estimating uncertain spatial relationships in robotics,” in Autonomous Robot Vehicles, New York, USA, 1990, pp. 167–193.

[3] M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, “FastSLAM: A factored solution to the simultaneous localization and mapping problem,” in Proc. of Theaaai National Conference on Artificial Intelligence. American Association for Artificial Intelligence, Edmonton, Canada, Jul. 2002, pp. 593–598.

[4] M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, “FastSLAM 2.0: An improved particle filtering algorithm for simultaneous localization and mapping that provably converges,” in International Joint Conference on Artificial Intelligence, Acapulco, Mexico, Aug. 2003, pp. 1151–1156.

[5] Grisetti G, Stachniss C, Burgard W. Improved techniques for grid mapping with Rao-Blackwellized particle filters. IEEE Transactions on Robotics, 2007, 23(1): 34-46.

[6] S. Kohlbrecher, O. V. Stryk, J. Meyer, and U. Klingauf, “A flexible and scalable SLAM system with full 3D motion estimation,” in IEEE International Symposium on Safety, Security, and Rescue Robotics, Kyoto, Japan, Nov. 2011, pp. 155–160.

[7] R. Kümmerle, G. Grisetti, H. Strasdat, K. Konolige, and W. Burgard, “G2o: A general framework for graph optimization,” in IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China, May. 2011, pp. 3607–3613.

[8] Besl P J, McKay N D. A method for registration of 3-D shapes. IEEE Transactions on Pattern Analysis and Machine Intelligence, 1992, 14(2): 239-256.

[9] A. Censi, “An ICP variant using a point-to-line metric,” in IEEE International Conference on Robotics and Automation (ICRA), Pasadena, USA, May. 2008, pp. 19–25.

[10] P. Biber and W. Strasser, “The normal distributions transform: A new approach to laser scan matching,” in IEEE International Conference on Intelligent Robots and Systems (IROS), Las Vegas, USA, Oct. 2003, pp. 2743–2748.

[11] E. B. Olson, “Real-time correlative scan matching,” in IEEE International Conference on Robotics and Automation (ICRA), Kobe, Japan, May. 2009, pp. 4387–4393.

[12] A. Tagliabue, J. Tordesillas, X. Cai, A. Santamaria-Navarro, J. P. How, L. Carlone, et al., “LION: lidar-inertial observability-aware navigator for vision-denied environments,” in International Symposium on Experiment Robotics, La Valletta, Malta, Nov. 2020, pp. 380–390.

[13] Lu F, Milios E. Globally consistent range scan alignment for environment mapping. Autonomous Robots, 1997, 4(4): 333-349.

[14] K. Konolige, G. Grisetti, R. Kummerle, W. Burgard, B. Limketkai, and R. Vincent, “Efficient sparse pose adjustment for 2d mapping,” in IEEE International Conference on Intelligent Robots and Systems (IROS), Taipei, China, Oct. 2010, pp. 22–29.

[15] L. Carlone, R. Aragues, J. A. Castellanos, and B. Bona, “A linear approximation for graph-based simultaneous localization and mapping,” in Robotics: Science and Systems, Sydney, Australia, Jul. 2012, pp. 41–48.

[16] W. Hess, D. Kohler, H. Rapp, and D. Andor, “Real-time loop closure in 2d lidar SLAM,” in IEEE International Conference on Robotics and Automation (ICRA), Stockholm, Sweden, May. 2016, pp. 1271–1278.

[17] Ren R, Fu H, Wu M. Large-scale outdoor SLAM based on 2D lidar. Electronics, 2019, 8(6): 6-13.

[18] J. G. Mangelson, D. Dominic, R. M. Eustice, and R. Vasudevan, “Pairwise consistent measurement set maximization for robust multi-robot map merging,” in IEEE International Conference on Robotics and Automation (ICRA), Prague, Australia, May 2018, pp. 2916–2923.

[19] M. Kaess, H. Johannsson, R. Roberts, V. Ila, J. Leonard, and F. Dellaert, “iSAM2: Incremental smoothing and mapping with fluid relinearization and incremental variable reordering,” in IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China, May 2011, pp. 3281–3288.

[20] J. Zhang, M. Kaess, and S. Singh, “On degeneracy of optimization-based state estimation problems,” in IEEE International Conference on Robotics and Automation (ICRA), Stockholm, Sweden, May 2016, pp. 809–816.

[21] A. Schaefer, D. Büscher, L. Luft, and W. Burgard, “A maximum likelihood approach to extract polylines from 2D laser range scans,” in IEEE International Conference on Intelligent Robots and Systems (IROS), Madrid, Spanish, Oct. 2018, pp. 4766–4773.

[22] Pattabiraman B, Patwary M M A, Gebremedhin A H, Liao W, Choudhary A. Fast algorithms for the maximum clique problem on massive graphs with applications to overlapping community detection. Internet Mathematics, 2014, 11(4–5): 421-448.

[23] Li Y F, Huang H Z, Mi J, Peng W, Han X. Reliability analysis of multi-state systems with common cause failures based on Bayesian network and fuzzy probability. Annals of Operations Research, 2022, 311(1): 195-209.

[24] Li Y F, Liu Y, Huang T, Huang H Z, Mi J. Reliability assessment for systems suffering common cause failure based on Bayesian networks and proportional hazards model. Quality and Reliability Engineering International, 2020, 36(7): 2509-2520.