Mechanical Engineering

A GPS-Laser-IMU Fusion Mapping Algorithm Based on Iterated Kalman Filter

Expand
  • School of Mechanical Engineering,Dalian University of Technology,Dalian 116024,Liaoning,China
丛明(1963-),男,博士,教授,主要从事工业机器人及自动化生产线技术、机器人智能化控制技术和仿生机器人技术等研究。E-mail: congm@dlut.edu.cn
刘冬(1985-),男,博士,副教授,主要从事机器人自主规划与导航、机器人学习和类脑认知智能等研究。

Received date: 2022-10-14

  Online published: 2023-10-27

Supported by

the National Natural Science Foundation of China(62173064); the Joint Fund of the Ministry of Education for Equipment Pre-research(8091B022119)

Abstract

3D laser SLAM in outdoor large-scale scenes has been a challenging problem in the current field of robot navigation and environment sensing. Due to the instability of GPS signals in some environments and the error accumulation property of laser SLAM, traditional algorithms perform poorly in large-scale scenes. In order to solve the problems of error accumulation of 3D laser SLAM (simultaneous localization and mapping) in outdoor large-scale scenes, this paper proposed a GPS-Laser-IMU fusion mapping algorithm based on iterated Kalman filter, which improves the mapping accuracy and robustness. The algorithm used IMU to predict the robot state, while laser and GPS data were used as observations to update the robot state. The measurement equations and the related Jacobian matrix were derived. Integrating the absolute position information of GPS data in odometer can solve the problem of error accumulation in long-time operation. In the environment with sparse features, the algorithm may collapse due to insufficient constraints. The introduction of GPS can improve the robustness of the system. Additionally, gravity plays a crucial role in the prediction of robot state. Although gravity is a three-dimensional vector, the module length of gravity remains constant when the region does not change, so gravity was treated as a two-degree-of-freedom vector. Transforming gravity optimization into optimization on SO(3) successfully avoids over-parameterization issues, thereby improving precision. Its performance was compared with that of other algorithms in outdoor environments and the robustness and accuracy were verified in large scale scenes. The results show that the root mean square error of this algorithm is 0.089 m, which is 54% lower than that of other algorithms.

Cite this article

CONG Ming, WEN Xu, WANG Minghao, et al . A GPS-Laser-IMU Fusion Mapping Algorithm Based on Iterated Kalman Filter[J]. Journal of South China University of Technology(Natural Science), 2024 , 52(3) : 75 -83 . DOI: 10.12141/j.issn.1000-565X.220667

References

1 DURRANT-WHYTE H, BAILEY T .Simultaneous localization and mapping:part I[J].IEEE Robotics & Automation Magazine200613(2):99-110.
2 BESL P J, MCKAY N D .A method for registration of 3D shapes[J].IEEE Transactions on Pattern Analycis & Machine Intelligence199214(2):239-256.
3 SEGAL A, HAEHNEL D, THRUN S .Generalized-ICP[C]∥Proceedings of Robotics:Science and Systems.Seattle:MIT Press,2009:435-442.
4 ZHANG J, SINGH S .Visual-lidar odometry and mapping:low-drift,robust,and fast[C]∥Proceedings of the IEEE International Conference on Robotics and Automation.Seattle:IEEE,2015:2174-2181.
5 SHAN T, ENGLOT B . Shan T,et al .LeGO-LOAM:lightweight and ground-optimized lidar odometry and mapping on variable terrain[C]∥Proceedings of 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).Madrid:IEEE,2019:4758-4765.
6 SHAN T, ENGLOT B, MEYERS D,et al .LIO-SAM:tightly-coupled lidar inertial odometry via smoothing and mapping[C]∥Proceedings of 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).Las Vegas:IEEE,2020:5135-5142.
7 WANG H, WANG C, CHEN C L,et al .F-loam:fast lidar odometry and mapping[C]∥Proceedings of 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems(IROS).Prague:IEEE,2021:4390-4396.
8 LIN J, ZHANG F .Loam livox:a fast,robust,high-precision lidar odometry and mapping package for lidars of small fov[C]∥Proceedings of 2020 IEEE International Conference on Robotics and Automation (ICRA).[S.l.]:Virtual Conference,2020:3126-3131.
9 LYNEN S, ACHTELIK M W, WEISS S,et al .Robust and modular multi-sensor fusion approach applied to mav navigation[C]∥Proceedings of 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.Tokyo:IEEE,2013:3923-3929.
10 ZHEN W, ZENG S, SOBERER S .Robust localization and localizability estimation with a rotating laser scanner[C]∥Proceedings of 2017 IEEE International Conference on Robotics and Automation (ICRA).Singapore:IEEE,2017:6240-6245.
11 GAO Y, LIU S, MOHAMED A,et al .INS/GPS/LiDAR integrated navigation system for urban and indoor environments using hybrid scan matching algorithm[J].Sensors201515(9):23286-23302.
12 YE H, CHEN Y, LIU M .Tightly coupled 3d lidar inertial odometry and mapping[C]∥Proceedings of IEEE International Conference on Robotics and Automation.Montreal:IEEE,2019:3144-3150.
13 FORSTER C, CARLONE L, DELLAERT F,et al .On-manifold preintegration for real-time visual-inertial odometry[J].IEEE Transactions on Robotics201733(1):1-21.
14 KAESS M, JOHANNSSON H, ROBERTS R,et al .iSAM2:incremental smoothing and mapping using the bayes tree[J].The International Journal of Robotics Research201231(2):216-235.
15 XU W, ZHANG F .FAST-LIO:a fast,robust lidar-inertial odometry package by tightly-coupled iterated kalman filter[J].IEEE Robotics and Automation Letters20216(2):3317-3324.
16 XU W, CAI Y, HE D,et al. FAST-LIO2:fast direct lidar-inertial odometry[J].IEEE Transactions on Robotics202238(4):2053-2073.
17 HE D, XU W, ZHANG F .Kalman filters on differentiable manifolds[J].arXiv preprint arXiv:2102.03804,2021.
18 CAI Y, XU W, ZHANG F .ikd-Tre:an incremental kd tree for robotic applications[J].arXiv preprint arXiv:2102.10808,2021.
19 KIM G, KIM A .Scan context:egocentric spatial descriptor for place recognition within 3d point cloud map[C]∥Proceedings of 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).Madrid:IEEE,2018:4802-4809.
20 WANG H, WANG C, XIE L .Intensity scan context:coding intensity and geometry relations for loop closure detection[C]∥Proceedings of 2020 IEEE International Conference on Robotics and Automation (ICRA).[S.l.]:Virtual Conference,2020:2095-2101.
21 GUO J, BORGES P V K, PARK C,et al .Local descriptor for robust place recognition using lidar intensity[J].IEEE Robotics and Automation Letters20194(2):1470-1477.
22 SOLA J .Quaternion kinematics for the error-state Kalman filter[J].arXiv preprint arXiv:1711.02508,2017.
23 MOORE T, STOUCH D .A generalized extended kalman filter implementation for the robot operating system[C]∥Proceedings of the 13th International Conference on Intelligent Autonomous Systems (IAS).Padua:IEEE,2016:335-348.
24 YIN J, LI A, LI T,et al .M2dgr:a multi-sensor and multi-scenario slam dataset for ground robots[J].IEEE Robotics and Automation Letters20217(2):2266-2273.
Outlines

/