Comparison and Analysis of LIDAR-based SLAM Frameworks in Dynamic Environments with Moving Objects

Accurate localization and reliable mapping is essential for autonomous navigation of robots. As one of the core technologies for autonomous navigation, Simultaneous Localization and Mapping (SLAM) has attracted widespread attention in recent decades. Based on vision or LiDAR sensors, great efforts have been devoted to achieving real-time SLAM that can support a robot’s state estimation. However, most of the mature SLAM methods generally work under the assumption that the environment is static, while in dynamic environments they will yield degenerate performance or even fail. In this paper, first we quantitatively evaluate the performance of the state-of-the-art LiDAR-based SLAMs taking into account different pattens of moving objects in the environment. Through semi-physical simulation, we observed that the shape, size, and distribution of moving objects all can impact the performance of SLAM significantly, and obtained instructive investigation results by quantitative comparison between LOAM and LeGO-LOAM. Secondly, based on the above investigation, a novel approach named EMO to eliminating the moving objects for SLAM fusing LiDAR and mmW-radar is proposed, towards improving the accuracy and robustness of state estimation. The method fully uses the advantages of different characteristics of two sensors to realize the fusion of sensor information with two different resolutions. The moving objects can be efficiently detected based on Doppler effect by radar, accurately segmented and localized by LiDAR, then filtered out from the point clouds through data association and accurate synchronized in time and space. Finally, the point clouds representing the static environment are used as the input of SLAM. The proposed approach is evaluated through experiments using both semi-physical simulation and real-world datasets. The results demonstrate the effectiveness of the method at improving SLAM performance in accuracy (decrease by 30% at least in absolute position error) and robustness in dynamic environments.

With the advancement of Light Detection and Ranging (LiDAR) technology and computer science, LiDAR–Inertial Simultaneous Localization and Mapping (SLAM) has become essential in autonomous driving, robotic navigation, and 3D reconstruction. However, dynamic objects such as pedestrians and vehicles, with complex terrain conditions, pose serious challenges to existing SLAM systems. These factors introduce artifacts into the acquired point clouds and result in significant vertical drift in SLAM trajectories. To address these challenges, this study focuses on controlling vertical drift errors in LiDAR–Inertial SLAM systems operating in dynamic environments. The research focuses on three key aspects: ground point segmentation, dynamic artifact removal, and vertical drift optimization. In order to improve the robustness of ground point segmentation operations, this study proposes a method based on a concentric sector model. This method divides point clouds into concentric regions and fits flat surfaces within each region to accurately extract ground points. To mitigate the impact of dynamic objects on map quality, this study proposes a removal algorithm that combines multi-frame residual analysis with curvature-based filtering. Specifically, the algorithm tracks residual changes in non-ground points across consecutive frames to detect inconsistencies caused by motion, while curvature features are used to further distinguish moving objects from static structures. This combined approach enables effective identification and removal of dynamic artifacts, resulting in a reduction in vertical drift.

In this work, we tested Simultaneous localization and mapping (SLAM) about mobile robots in indoor environment, where all experiments were conducted based on the Robot Operating System (ROS). The urban search and rescue(USAR) environment was build in the ROS simulation tool Gazebo, and our car was used to test hector SLAM in Gazebo. The rplidar A1 single-line lidar was used for 2D laser scan matching data acquisition in the practical experiments and the indoor map was built by using the open source algorithms gmapping, karto SLAM, hector SLAM software package for indoor SLAM, which can get the indoor grid maps in ROS graphical tool RVIZ. The experimental results of the three open source algorithms show that the mobile robot for simultaneous localization and mapping (SLAM) is feasible, and high-precision grid maps can be constructed.

Autonomous service robots are gaining popularity as they find application in different sectors such as logistics, hospitality, medical, space exploration and military. It is widely seen that autonomous service robots help increase efficiency, reduce cost and ensure safer operations. Automating material handling operations in highly dynamic indoor environments is risky and involves use of complex algorithms. However, continuously advancing technologies and machine programming tend to overcome these challenges. The three essential functions of an autonomous robot are to identify its instantaneous location in three-dimensional space, generate the environment map and decide an optimal path for locomotion. Simultaneous Localization and Mapping (SLAM) is a widely used algorithm for navigation in unfamiliar environments. This chapter presents a cost-effective autonomous ground robot for automating material handling, transportation and other repetitive tasks in dynamically changing surroundings. The robot is programmed to map the indoor environment and localize itself in the workspace with the help of SLAM and Adaptive Monte Carlo Localization (AMCL). In addition, the robot can manoeuvre through the indoor workspace by avoiding static and dynamic obstacles. This work employs the GMapping open-source package in the Robot Operating System (ROS) for performing SLAM with the aid of a laser range finder, wheel odometry and inertial data. The GMapping algorithm uses a probabilistic approach to construct a map and estimate the robot’s location in two-dimensional space. In addition, this chapter presents an autonomous navigation feature with the help of the AMCL method for localizing the robot within an uncertain environment and making the robot move to its goal using move base actions in ROS. The path planning of the mobile robot is classified into global and local plans. The global plan is responsible for planning the path from the start point to the endpoint. The local plan is responsible for planning the actual movement of the robot by avoiding any dynamic obstacles not mapped earlier. This work uses the Dijistra algorithm for the global and the dynamic window approach (DWA) algorithm for the local path planning. The optimization algorithm minimizes the error between the global and local paths. The simulation study of the proposed algorithm is performed in a virtual environment called Gazebo in ROS, which is nearly similar to a real-time indoor workspace. Further, a robot prototype is fabricated, and its performance is evaluated in an unknown environment. The robot prototype is equipped with brushed DC motors with optical encoder feedback for wheel odometry (ODOM), Light Detection and Ranging (LiDAR), and Inertial Measurement Unit (IMU) sensors controlled using a Jetson Nano. The simulation and experimental results showcase the robot’s successful two-dimensional localization and navigation in the factory environment. The current system has the potential for indoor assistance during material transfer and logistic applications. Further upgrades to the system can make it usable for Automated Storage and Retrieval System (ASRS) applications in warehouses/factories.

Visual simultaneous localization and mapping (SLAM) in dynamic environments has received significant attention in recent years, and accurate segmentation of real dynamic objects is the key to enhancing the accuracy of pose estimation in such environments. In this study, we propose a visual SLAM approach based on ORB-SLAM3, namely dynamic multiple object tracking SLAM (DMOT-SLAM), which can accurately estimate the camera’s pose in dynamic environments while tracking the trajectories of moving objects. We introduce a spatial point correlation constraint and combine it with instance segmentation and epipolar constraint to identify dynamic objects. We integrate the proposed motion check method into DeepSort, an object tracking algorithm, to facilitate inter-frame tracking of dynamic objects. This integration not only enhances the stability of dynamic features detection but also enables the estimation of global motion trajectories for dynamic objects and the construction of object-level semi-dense semantic maps. We evaluate our approach on the public TUM, Bonn, and KITTI dataset, and the results show that our approach has a significant improvement over ORB-SLAM3 in dynamic scenes and performs better compared to other state-of-the-art SLAM approaches. Moreover, experiments in real-world scenarios further substantiate the effectiveness of our approach.

An Adaptive SVSF-SLAM Algorithm in Dynamic Environment for Cooperative Unmanned Vehicles

Simultaneous localization and mapping (SLAM) is a basic prerequisite in autonomous mobile robotics. Most existing visual SLAM approaches either assume a static environment, or simply ’forget’ old parts of the map to cope with map size constraints and scene dynamics. We present a novel map representation for sparse visual features. A new 3D point descriptor called Histogram of Oriented Cameras (HOC) encodes anisotropic spatial visibility information and the importance of each three-dimensional landmark. Each feature holds and updates a histogram of the poses of observing cameras. It is hereby able to estimate its probability of occlusion and importance for localization from a given viewpoint. In a series of simulated and real-world experiments we prove that the proposed descriptor allows to cope with dynamic changes in the map, improves localization accuracy and enables reasonable control of the map size.

Remotely Operated Underwater Vehicles (ROUVs) are increasingly important for high-resolution surveying of narrow shipping lanes. This paper presents 3Clifs, a LiDAR- and AI-enhanced ROUV designed for near-real-time topographic mapping and navigation support in shallow, constrained waterways, demonstrated at three cliff sites in the Suez Canal. The system integrates three-dimensional Light Detection and Ranging (LiDAR) scanning, an Inertial Measurement Unit (IMU), and an onboard processor running the Robot Operating System (ROS) for Simultaneous Localization and Mapping (SLAM). To address data loss from underwater LiDAR (caused by scattering and reflection), we introduce an AI-driven optimisation module that reconstructs missing point cloud data and improves SLAM continuity. We also report propulsion and propeller design changes (propeller v05_1) that reduce flow turbulence and improve scan stability. We compare our approach to sonar-only ROUV mapping and to recent ROUV/LiDAR studies using metrics including point-cloud completeness, SLAM continuity, and navigation-path deviation. The main contributions are: (i) an integrated LiDAR, ROS and AI pipeline for underwater SLAM with missing-point recovery; (ii) a propulsion configuration optimized for LiDAR scanning stability; and (iii) a real-world Suez Canal case study demonstrating practical benefits for narrow-lane navigation.

The purpose of this paper is to offer a unique adaptive path planning framework to address a new challenge known as the Unknown environment Persistent Monitoring Problem (PMP). To identify the unknown events’ occurrence location and likelihood, an unmanned ground vehicle (UGV) equipped with a Light Detection and Ranging (LIDAR) and camera is used to record such events in agriculture land. A certain level of detecting capability must be the distinct monitoring priority in order to keep track of them to a certain distance. First, to formulate a model, we developed an event-oriented modelling strategy for unknown environment perception and the effect is enumerated by uncertainty, which takes into account the sensor’s detection capabilities, the detection interval, and monitoring weight. A mobile robot scheme utilizing LIDAR on integrative approach was created and experiments were carried out to solve the high equipment budget of Simultaneous Localization and Mapping (SLAM) for robotic systems. To map an unfamiliar location using the robotic operating system (ROS), the 3D visualization tool for Robot Operating System (RVIZ) was utilized, and GMapping software package was used for SLAM usage. The experimental results suggest that the mobile robot design pattern is viable to produce a high-precision map while lowering the cost of the mobile robot SLAM hardware. From a decision-making standpoint, we built a hybrid algorithm HSAStar (Hybrid SLAM & A Star) algorithm for path planning based on the event oriented modelling, allowing a UGV to continually monitor the perspectives of a path. The simulation results and analyses show that the proposed strategy is feasible and superior. The performance of the proposed hyb SLAM-A Star-APP method provides 34.95%, 27.38%, 33.21% and 29.68% lower execution time, 26.36%, 29.64% and 29.67% lower map duration compared with the existing methods, such as ACO-APF-APP, APFA-APP, GWO-APP and PSO-APP.

Simultaneous localization and mapping (SLAM) has been investigated in the field of robotics for two decades, as it is considered to be an effective method for solving the positioning and mapping problem in a single framework. In the SLAM community, the Extended Kalman Filter (EKF) based SLAM and particle filter SLAM are the most mature technologies. After years of development, graph-based SLAM is becoming the most promising technology and a lot of progress has been made recently with respect to accuracy and efficiency. No matter which SLAM method is used, loop closure is a vital part for overcoming the accumulated errors. However, in 2D Light Detection and Ranging (LiDAR) SLAM, on one hand, it is relatively difficult to extract distinctive features in LiDAR scans for loop closure detection, as 2D LiDAR scans encode much less information than images; on the other hand, there is also some special mapping scenery, where no loop closure exists. Thereby, in this paper, instead of loop closure detection, we first propose the method to introduce extra control network constraint (CNC) to the back-end optimization of graph-based SLAM, by aligning the LiDAR scan center with the control vertex of the presurveyed control network to optimize all the poses of scans and submaps. Field tests were carried out in a typical urban Global Navigation Satellite System (GNSS) weak outdoor area. The results prove that the position Root Mean Square (RMS) error of the selected key points is 0.3614 m, evaluated with a reference map produced by Terrestrial Laser Scanner (TLS). Mapping accuracy is significantly improved, compared to the mapping RMS of 1.6462 m without control network constraint. Adding distance constraints of the control network to the back-end optimization is an effective and practical method to solve the drift accumulation of LiDAR front-end scan matching.

<span lang="EN-US">In recent years, there has been a strong demand for self-driving cars. For safe navigation, self-driving cars need both precise localization and robust mapping. While global navigation satellite system (GNSS) can be used to locate vehicles, it has some limitations, such as satellite signal absence (tunnels and caves), which restrict its use in urban scenarios. Simultaneous localization and mapping (SLAM) are an excellent solution for identifying a vehicle’s position while at the same time constructing a representation of the environment. SLAM-based visual and light detection and ranging (LIDAR) refer to using cameras and LIDAR as source of external information. This paper presents an implementation of SLAM algorithm for building a map of environment and obtaining car’s trajectory using LIDAR scans. A detailed overview of current visual and LIDAR SLAM approaches has also been provided and discussed. Simulation results referred to LIDAR scans indicate that SLAM is convenient and helpful in localization and mapping.</span>

Facing the realistic demands of the application environment of robots, the application of simultaneous localisation and mapping (SLAM) has gradually moved from static environments to complex dynamic environments, while traditional SLAM methods usually result in pose estimation deviations caused by errors in data association due to the interference of dynamic elements in the environment. This problem is effectively solved in the present study by proposing a SLAM approach based on light detection and ranging (LiDAR) under semantic constraints in dynamic environments. Four main modules are used for the projection of point cloud data, semantic segmentation, dynamic element screening, and semantic map construction. A LiDAR point cloud semantic segmentation network SANet based on a spatial attention mechanism is proposed, which significantly improves the real-time performance and accuracy of point cloud semantic segmentation. A dynamic element selection algorithm is designed and used with prior knowledge to significantly reduce the pose estimation deviations caused by SLAM dynamic elements. The results of experiments conducted on the public datasets SemanticKITTI, KITTI, and SemanticPOSS show that the accuracy and robustness of the proposed approach are significantly improved.

In this paper we present a simulation framework for the evaluation of the navigation and localization metrological performances of a robotic platform. The simulator, based on ROS (Robot Operating System) Gazebo, is targeted to a planetary-like research vehicle which allows to test various perception and navigation approaches for specific environment conditions. The possibility of simulating arbitrary sensor setups comprising cameras, LiDARs (Light Detection and Ranging) and IMUs makes Gazebo an excellent resource for rapid prototyping. In this work we evaluate a variety of open-source visual and LiDAR SLAM (Simultaneous Localization and Mapping) algorithms in a simulated Martian environment. Datasets are captured by driving the rover and recording sensors outputs as well as the ground truth for a precise performance evaluation.

Simultaneous Localization and Mapping (SLAM) is critical for autonomous driving. Compared with visual SLAM which suffers from variable lighting conditions and sparse features, Light Detection and Ranging (LiDAR) based solution is highly competitive since LiDAR can offer precise distance measurements and robust resistance to changes in illumination. However, current LiDAR SLAM techniques only estimate pose from a single scale, such that complex environments with dynamic objects and similar features can heavily affect the performance, leading to poor accuracy and robustness of pose estimation. To address these challenges, we present MTC-SLAM, a multi-scale and tightly coupled LiDAR-Inertial SLAM method. It begins with a coarse adjustment across six degrees of freedom at a larger scale, followed by adaptive step-size least squares updates for <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$\boldsymbol{x}$</tex-math></inline-formula>, <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$\boldsymbol{y}$</tex-math></inline-formula>, and <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$\boldsymbol{yaw}$</tex-math></inline-formula> on a smaller scale, and dynamic interpolation updates for <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$\boldsymbol{z}$</tex-math></inline-formula>, <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$\boldsymbol{pitch}$</tex-math></inline-formula>, and <inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$\boldsymbol{roll}$</tex-math></inline-formula>. The updated poses are integrated as odometer factors, alongside Global Positioning System (GPS) and loop closure factors, to construct a factor graph for backend optimization. Additionally, a multi-scale loop closure detection method is proposed to identify loops using multi-scale descriptors for global optimization. Extensive experiments on the MulRan dataset demonstrate that MTC-SLAM outperforms existing mainstream methods in both accuracy and robustness.

This paper presents a Light Detection and Ranging (LiDAR) data set that targets complex urban environments. Urban environments with high-rise buildings and congested traffic pose a significant challenge for many robotics applications. The presented data set is unique in the sense it is able to capture the genuine features of an urban environment (e.g. metropolitan areas, large building complexes and underground parking lots). Data of two-dimensional (2D) and threedimensional (3D) LiDAR, which are typical types of LiDAR sensors, are provided in the data set. The two 16-ray 3D LiDARs are tilted on both sides for maximal coverage. One 2D LiDAR faces backward while the other faces forwards to collect data of roads and buildings, respectively. Raw sensor data from Fiber Optic Gyro (FOG), Inertial Measurement Unit (IMU), and the Global Positioning System (GPS) are presented in a file format for vehicle pose estimation. The pose information of the vehicle estimated at 100 Hz is also presented after applying the graph simultaneous localization and mapping (SLAM) algorithm. For the convenience of development, the file player and data viewer in Robot Operating System (ROS) environment were also released via the web page. The full data sets are available at: http://irap.kaist.ac.kr/dataset. In this website, 3D preview of each data set is provided using WebGL.