Abstract:Most of the existing simultaneous localization and mapping (SLAM) methods are based on the static environment assumption. The presence of moving objects in the scene will lead to much uncertainty in SLAM results, which also hinders the loop-closure detection (LCD). Although moving object tracking (MOT) is necessary for planning and decisions, it is often accomplished separately. To jointly solve SLAM and MOT for complex urban driving scenarios, this paper presents a high performance method named 4D-SLAM based on the fusion of LiDAR and IMU. The integration of SLAM and MOT is formulated as a joint posterior probability problem based on a dynamic Bayesian network (DBN) and is implemented with the following four sequential stages: preprocessing, moving object detection and tracking, odometry estimation and mapping. In the preprocessing stage, the motion distortion uncertainty caused by LiDAR scanning is first compensated for, and the initial LiDAR motion is estimated. In the moving object detection and tracking stage, we exploit a CNN-based segmentation network to detect the potential moving objects first, then the states of the potential moving objects are optimized by an unscented Kalman filter (UKF). In the odometry estimation stage, the distinctive planar and edge features extracted from a static background point cloud are used for the odometry estimation, and a two-step Levenberg-Marquardt optimization method is adopted to solve the 6DOF pose across consecutive scans. In the mapping stage, the mapping based on the pose estimation result and LCD are realized, and graph-based global optimization is exploited to further improve the map consistency for large scale environment. The comprehensive experiments with the open source dataset KITTI and the data collected by us show that the presented method not only outperforms the SOTA SLAM methods in terms of trajectory and mapping accuracy but can also detect and track moving objects efficiently.

A New Multimodal Map Building Method Using Multiple Object Tracking and Gaussian Process Regression

Mapbuilding for Dynamic Environments Using Grid Vectors

GPU Accelerated Real-Time Traversability Mapping.

MAPPING WITHOUT DYNAMIC: ROBUST LiDAR-SLAM FOR UGV MOBILE MAPPING IN DYNAMIC ENVIRONMENTS

GPmap: A Unified Framework for Robotic Mapping Based on Sparse Gaussian Processes

Online Mapping with a Mobile Robot in Dynamic and Unknown Environments

Outlier-Robust Long-Term Robotic Mapping Leveraging Ground Segmentation

Mixed-model based simultaneous localization and mapping approach for mobile robot

Multi-Objective Location and Mapping Based on Deep Learning and Visual Slam

MM3DGS SLAM: Multi-modal 3D Gaussian Splatting for SLAM Using Vision, Depth, and Inertial Measurements

Visual SLAM with Multi-Object Tracking Using Hybrid Features

Occupancy Grid Map to Pose Graph-based Map: Robust BIM-based 2D-LiDAR Localization for Lifelong Indoor Navigation in Changing and Dynamic Environments

Gaussian Process Autonomous Mapping and Exploration for Range Sensing Mobile Robots

GPGM-SLAM: a Robust SLAM System for Unstructured Planetary Environments with Gaussian Process Gradient Maps

A LiDAR Mapping System for Robot Navigation in Dynamic Environments

3D Point Cloud-based Scene Understanding for Dynamic Large Scale Environment*

4-D SLAM: an Efficient Dynamic Bayes Network-Based Approach for Dynamic Scene Understanding.

MR-GMMapping: Communication Efficient Multi-Robot Mapping System via Gaussian Mixture Model

TOSS: Real-time Tracking and Moving Object Segmentation for Static Scene Mapping

LD-SLAM: A Robust and Accurate GNSS-Aided Multi-Map Method for Long-Distance Visual SLAM

Increasing the Efficiency of 6-DoF Visual Localization Using Multi-Modal Sensory Data