wolf943134497 / ct-lio

CT-LIO: Continuous-Time LiDAR-Inertial Odometry

ct-lio

CT-LIO: Continuous-Time LiDAR-Inertial Odometry

ct-lio (Continuous-Time LiDAR-Inertial Odometry) is an accurate and robust LiDAR-inertial odometry (LIO). It fuses LiDAR constraints(ct-icp) with IMU data using ESKF(loose couple) to allow robost localizate in fast moton (as lio-sam). Besides, we provide analytical derivation and automatic derivation for ct-icp, and a simple degradation detection.

• Video-Bilibili

Some test results are show below:

Velodyne 32, NCLT dataset

(mode:normal + eskf)

• Video-Bilibili

Ouster-32, multi-layer office

• Video-Bilibili

Left: ours (mode:normal + eskf)

Right: fast-lio2

Robosense RS16, staircase_crazy_rotation dataset

• Video-Bilibili

Left: PV_LIO

Right: ours (mode:normal + eskf)

• Video-Bilibili

Velodyne 16, LIO-SAM dataset

Left: ours (mode:normal + eskf)

Right: direct_lidar_inertial_odometry

Velodyne 16, LIO-SAM dataset

(mode:CT + eskf)

1. Prerequisites

1.1 Ubuntu and ROS

Ubuntu >= 18.04

For Ubuntu 18.04 or higher, the default PCL and Eigen is enough for PV-LIO to work normally.

ROS >= Melodic. ROS Installation

1.2. PCL && Eigen

PCL >= 1.8, Follow PCL Installation.

Eigen >= 3.3.4, Follow Eigen Installation.

2. Build

Clone the repository and catkin_make:

NOTE:[This is import] before catkin_make, make sure your dependency is right(you can change in ./cmake/packages.cmake)

    cd ~/$A_ROS_DIR$/src
    git clone https://github.com/chengwei0427/ct-lio.git
    cd ct_lio
    cd ../..
    catkin_make
    source devel/setup.bash

• If you want to use a custom build of PCL, add the following line to ~/.bashrc export PCL_ROOT={CUSTOM_PCL_PATH}

3. Directly run

Noted:

A. Please make sure the IMU and LiDAR are Synchronized, that's important.

B. The warning message "Failed to find match for field 'time'." means the timestamps of each LiDAR points are missed in the rosbag file. That is important for the forward propagation and backwark propagation.

C. Before run with NCLT dataset, you should change time-scale in cloud_convert.cpp( static double tm_scale = 1e6)

D. Run with a bag directly.

1. uncomment the node in the launch file with "main_eskf_rosbag"
2. change the bag name in the ./apps/main_eskf_rosbag.cpp ,such as 'std::string bag_path_ = "/media/cc/robosense16/2023-04-16-21-39-59_new.bag";'
3. re compile the code
4. run with launch file

E. change analytical derivation and automatic derivation in ./lio/lidarodom.cpp with #define USE_ANALYTICAL_DERIVATE

4. Rosbag Example

4.1 Robosense 16 Rosbag

Files: Can be downloaded from Baidu Pan (password:4kpf) or Google Drive

Noted: For this narrow staircases, should adjust the params(such as surf_res etc.) before run the program.

Run:

roslaunch sr_lio run_eskf.launch
cd YOUR_BAG_DOWNLOADED_PATH
rosbag play *

4.2 Time analysis

There is a time log file in ./log/ after run the code. we can plot the time with the scripts.

cd CT-LIO
python3 ./scripts/all_time.py

Related Works

1. ct_icp: Continuous-Time LiDAR Odometry .
2. slam_in_autonomous_driving: SLAM in Autonomous Driving book
3. semi_elastic_lio: Semi-Elastic LiDAR-Inertial Odometry.

Acknowledgments