CT-ICP: Real-time Elastic LiDAR Odometry with Loop Closure

by   Pierre Dellenbach, et al.

Multi-beam LiDAR sensors are increasingly used in robotics, particularly for autonomous cars for localization and perception tasks. However, perception is closely linked to the localization task and the robot's ability to build a fine map of its environment. For this, we propose a new real-time LiDAR odometry method called CT-ICP, as well as a complete SLAM with loop closure. The principle of CT-ICP is to use an elastic formulation of the trajectory, with a continuity of poses intra-scan and discontinuity between scans, to be more robust to high frequencies in the movements of the sensor. The registration is based on scan-to-map with a dense point cloud as map structured in sparse voxels to operate in real time. At the same time, a fast method of loop closure detection using elevation images and an optimization of poses by graph allows to obtain a complete SLAM purely on LiDAR. To show the robustness of the method, we tested it on seven datasets: KITTI, KITTI-raw, KITTI-360, KITTI-CARLA, ParisLuco, Newer College, and NCLT in driving and high-frequency motion scenarios. The CT-ICP odometry is implemented in C++ and available online. The loop detection and pose graph optimization is in the framework pyLiDAR-SLAM in Python and also available online. CT-ICP is currently first, among those giving access to a public code, on the KITTI odometry leaderboard, with an average Relative Translation Error (RTE) of 0.59 per scan of 60ms on a CPU with a single thread.


page 1

page 2

page 4


Optimized SC-F-LOAM: Optimized Fast LiDAR Odometry and Mapping Using Scan Context

LiDAR odometry can achieve accurate vehicle pose estimation for short dr...

3D-SeqMOS: A Novel Sequential 3D Moving Object Segmentation in Autonomous Driving

For the SLAM system in robotics and autonomous driving, the accuracy of ...

Online LiDAR-SLAM for Legged Robots with Robust Registration and Deep-Learned Loop Closure

In this paper, we present a factor-graph LiDAR-SLAM system which incorpo...

Real-Time Simultaneous Localization and Mapping with LiDAR intensity

We propose a novel real-time LiDAR intensity image-based simultaneous lo...

Have I been here before? Learning to Close the Loop with LiDAR Data in Graph-Based SLAM

This work presents an extension of graph-based SLAM methods to exploit t...

Loop Closure Detection in Closed Environments

Low cost robots, such as vacuum cleaners or lawn mowers employ simplisti...

NDT-Map-Code: A 3D global descriptor for real-time loop closure detection in lidar SLAM

Loop-closure detection, also known as place recognition, aiming to ident...

Please sign up or login with your details

Forgot password? Click here to reset