Awesome
LLS-LOAM
Lidar Odometry and Mapping with Mutiple Metrics Linear Least Square ICP
Principle
Instead of using non-linear optimization when doing transformation estimation, this algorithm use the linear least square for all of the point-to-point, point-to-line and point-to-plane distance metrics during the ICP registration process based on a good enough initial guess.
How to use
- Install dependent 3rd libraries:
If you'd like to use your own data and want to know its absolute projected coordinate, install Proj.
- Compile
mkdir build
cd build
cmake ..
make
- Run
cd ..
# If you'd like to test on kitti dataset
# See below for data preparation
sh script/kitti/kitti_xx.sh
# If you'd like to test on apollo southbay dataset
sh script/apollo/southbay_test.sh
# If you'd like to test on your own dataset, you need to create new shell files and then run it
How to prepare the data
For KITTI dataset, you may refer to Pointcloud Format Transform Tool.
After transforming the point cloud from .bin to .pcd, rename the point cloud folder HDL64.
Horizontally, create a folder called OXTS, and put the ground truth pose .txt file (which can be download from kitti's website) into it.
Then create a pcd file list:
touch file_list.txt
ls HDL64 >> file_list.txt
Then the data is ready for test.
For Baidu Appollo Dataset, you should download the testing data 'Apollo-SouthBay' from Baidu Apollo Data Platform. The data preparation is like kitti's. Remember to use the tool 'rename_number_pcd_files.sh' to regularize the pcd file names (for example, from 1.pcd to 0001.pcd).
For your own dataset, if the point cloud are in pcd format and the pose and imu information are in oxts format, then you can directly use this programme (LoadPcImuGnss Method). Or you need to transform the data youself.
The common folder structure should be
_____base_folder
|___HDL64
. |____0000.pcd
. |____0001.pcd
. |____.....pcd
|___OXTS
. |____pose.txt
|___file_list.txt
TO DO LIST
For the loop closure, pose graph optimization and collaboration mapping module, the code has not been released yet.
The workaround is here: CloudControlNet
-
Speed up
-
Solve the serious Z drift problem
-
Use DL to remove the dynamic objects
-
Add ROS module
-
Tech report or paper
Demo
On KITTI dataset
Yellow: Lidar Odometry Position, Purple: Ground Truth Position
seq 00
seq 01
seq 02
seq 03
seq 04
seq 05
seq 06
seq 07
seq 08
seq 09
seq 10
Quantity Evaluation on KITTI dataset
seq | ATE(%) | ARE(0.01deg/m) | TPF(ms/frame) |
---|---|---|---|
00 | 1.362 | 0.603 | 193.4 |
01 | 4.175 | 1.076 | 183.8 |
02 | 2.210 | 0.928 | 196.8 |
03 | 1.282 | 1.037 | 181.5 |
04 | 2.108 | 0.981 | 194.3 |
05 | 1.453 | 0.677 | 189.3 |
06 | 1.119 | 0.609 | 188.6 |
07 | 0.763 | 0.505 | 198.1 |
08 | 1.834 | 0.800 | 187.4 |
09 | 2.293 | 1.008 | 191.2 |
10 | 2.692 | 0.905 | 190.4 |