TRLO: An Efficient LiDAR Odometry with 3D Dynamic Object Tracking and Removal

Yanpeng Jia,Ting Wang,Xieyuanli Chen,Shiliang Shao

2024-10-17

Abstract:Simultaneous state estimation and mapping is an essential capability for mobile robots working in dynamic urban environment. The majority of existing SLAM solutions heavily rely on a primarily static assumption. However, due to the presence of moving vehicles and pedestrians, this assumption does not always hold, leading to localization accuracy decreased and maps distorted. To address this challenge, we propose TRLO, a dynamic LiDAR odometry that efficiently improves the accuracy of state estimation and generates a cleaner point cloud map. To efficiently detect dynamic objects in the surrounding environment, a deep learning-based method is applied, generating detection bounding boxes. We then design a 3D multi-object tracker based on Unscented Kalman Filter (UKF) and nearest neighbor (NN) strategy to reliably identify and remove dynamic objects. Subsequently, a fast two-stage iterative nearest point solver is employed to solve the state estimation using cleaned static point cloud. Note that a novel hash-based keyframe database management is proposed for fast access to search keyframes. Furthermore, all the detected object bounding boxes are leveraged to impose posture consistency constraint to further refine the final state estimation. Extensive evaluations and ablation studies conducted on the KITTI and UrbanLoco datasets demonstrate that our approach not only achieves more accurate state estimation but also generates cleaner maps, compared with baselines.

Robotics

What problem does this paper attempt to address?

The paper attempts to address the issues encountered by mobile robots in state estimation and mapping in dynamic urban environments. Specifically, most existing SLAM solutions rely on the assumption that the environment is primarily static. However, this assumption often does not hold in dynamic environments with moving vehicles and pedestrians, leading to decreased localization accuracy and map distortion. To tackle this challenge, the authors propose TRLO (an efficient LiDAR odometry), which improves the accuracy of state estimation and generates cleaner point cloud maps by detecting and removing dynamic objects.

The main contributions of the paper include:
1. Proposing a reliable 3D multi-object tracker based on the Unscented Kalman Filter (UKF) and Nearest Neighbor (NN) strategy for efficient detection and tracking of dynamic objects.
2. Introducing a hash-based keyframe database management method to accelerate keyframe search speed.
3. Applying pose consistency constraints using detected object bounding boxes to further optimize the final state estimation.
4. Conducting extensive evaluations and ablation studies on the KITTI and UrbanLoco datasets, demonstrating that the method not only achieves more accurate state estimation but also generates cleaner maps, outperforming baseline methods.

Through these techniques, TRLO aims to enhance the localization and mapping capabilities of mobile robots in dynamic environments, particularly in urban settings.