Multi-Sensor Fusion SLAM Based on Fast Euclidean Clustering to Filter Dynamic Targets

Yongxing Jia,Ziang Zhao,Xiaojian Qian,Ming Geng
DOI: https://doi.org/10.1109/ICSIP61881.2024.10671430
2024-07-12
Abstract:R3LIVE is a new multi-sensor fusion SLAM framework, which mainly uses the three sensors of lidar, camera and IMU to realize the effective fusion of heterogeneous data through the error state iterative Kalman filtering method, so as to achieve the function of efficient and accurate simultaneous positioning and mapping. Specifically, this system uses lidar and IMU to construct laser inertial odometer (LIO) to construct the geometry of the external environment, and also it builds a visual inertial odometer (VIO) with a camera and IMU to reconstruct a dense RGB map of the environment. However, in the face of the environment where dynamic objects appear, the positioning accuracy of the system will be affected due to the point cloud of the sensor on the dynamic objects. Moreover, the continuous point cloud of the dynamic objects will cause continuous “ghost” in the dense RGB map constructed. In order to solve the above problems, a fast Euclidean clustering algorithm is proposed to filter out dynamic targets, that is, before the LIO system laser point cloud registration, the input point cloud is initially classified by using a fast Euclidean clustering algorithm, and the original point cloud is divided into ground points, background points and foreground points, among which the ground points and background points are usually considered static points. The foreground points may be either dynamic or static points. Then, the viewpoint visibility method is used for the foreground points to further verify the existence of dynamic points, and the dynamic points in the foreground points are filtered out. Finally, a widely distributed sparse extraction method is designed to solve the problem of excessive extraction of surface features in scenes with rich structure and texture. This enhances the real-time performance and robustness of the system in dynamic scenarios.
Computer Science,Engineering
What problem does this paper attempt to address?