Skip to content

Zhaohuanfeng/LIO_SAM_6AXIS

 
 

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

65 Commits
 
 
 
 
 
 
 
 
 
 
 
 

Repository files navigation

hkust

LIO_SAM_6AXIS

This repo may help to adapt LIO_SAM for your own sensors!

  • support a 6-axis IMU, since the orientation information of IMU is not used in state estimation module.
  • support low-cost GNSS, we do not need to adapt for the robot_localization node.
  • support the gps constraint visualization module to help debugging the normal GNSS.(the following picture)

image-20220531015953876

image-20220609035032131

Latest News(2022-10-27)

  • fix some bugs of GNSS odometry, remove some useless codes in lio intialization module

  • add tf messages in *__result.bag so that we can use the result.bag to generate the gif demo above!

  • add rviz_satellate plugs which can show your point cloud on google map.

  • update orgin LLA of map origin point automatically during the optimization.

image-20221030051152185

Introduction

LIO_SAM is only designed for 9-axis IMU, for the following reasons.

  • the back-end GNSS-based optimization relies on the robot_localization node, and also requires a 9-axis IMU.

Therefore, only minor changes to the original code are required. which can directly use GPS points of good quality for optimization. Finally, we also made some explanations for some common lidars, as well as coordinate system adaptation and extrinsics between lidars and IMUs, such as Pandar.

we add the gps constraint visualization module to help debugging the normal gps(red lines represents for gps constraint).

Usage

Dependences

The same as LIO_SAM.

Video Tutorial

Docker

Dockerfile is for people who don't want to break their own environment. Running the algorithm in the docker. Recommend!

# please cd the folder which have Dockerfile first, approximately 10mins based on your internet and CPU
docker build -t zhangkin/lio_sam_6axis .

docker run -it --net=host --gpus all --name lio_sam_6axis zhangkin/lio_sam_6axis /bin/zsh

# OR -v to link the folder from your computer into container (your_computer_loc:container_loc)
docker run -it --net=host --gpus all --name lio_sam_6axis -v /home/kin/bag_data:/home/xchu/data/ramlab_dataset zhangkin/lio_sam_6axis /bin/zsh

# in the container
catkin build
source devel/setup.zsh

# with dataset download and linked ==> please see more usage in previous section
roslaunch lio_sam_6axis ouster128_indoors.launch

对于在内地的同学,可以换源dockerhub后,直接拉取:

docker pull zhangkin/lio_sam_6axis

follow these steps:

Single Sequence

  • hkust_20201105full
roslaunch lio_sam_6axis run.launch

when you set the useGPS true, you may get the following los. It means that these gps points are used for optimization.

[ INFO] [1651092699.914940274]: curr gps cov: 11.022400, 11.022400 , 176.358400
[ INFO] [1651092700.516013418]: curr gps pose: 13.806815, 7.928380 , 5.147980
[ INFO] [1651092700.516037958]: curr gps cov: 11.022400, 11.022400 , 176.358400
[ INFO] [1651092700.516045476]: curr gps pose: 13.868968, 8.179937 , 4.978980
[ INFO] [1651092700.516052422]: curr gps cov: 11.022400, 11.022400 , 176.358400
  • garden_day

when you use the garden_day rosbag, set your bag_path in the LIO-SAM-6AXIS/launch/ouster128_indoors.launch.

roslaunch lio_sam_6axis ouster128_indoors.launch

Batch Scripts

when you want to test on multi-sequence rosbag with the same set of sensor equipment. You just need to modify the script LIO-SAM-6AXIS/scripts/lio_loop_batch.py.

  1. put all your rosbag info one folder , and set it as the bag_path_downloadparams. set your rosbag file name(bag_path_list)

  2. set your sequence name (plat_data_pair_list)

  3. source your workspace(source devel/setup.zsh )

  4. run the script

python3 src/LIO-SAM-6AXIS/scripts/lio_loop_batch.py

Save Results

I will give the map and related example results constructed based on the instance data using LIO_SAM_6AXIS, once the sharing function of Baidu netdisk is normal.

rosservice call /lio_sam_6axis/save_map
  • campus_result.bag: inlcude 2 topics, the distorted point cloud and the optimzed odometry

  • odom_tum.txt

  • optimized_odom_kitti.txt

  • optimized_odom_tum.txt

  • pose_graph.g2o: the final pose graph g2o file

  • globalmap_lidar.pcd: global map in lidar frame.

  • globalmap_imu.pcd: global map in IMU body frame, but you need to set proper extrinsics.

  • globalmap_lidar_feature.pcd: edge+planer points map, based on lidar frame.

  • origin.txt: The origin of the point cloud map, which can be used for prior map-based localization.

  • optimized_gps_trajectry.kml: KML file for optimized trajectory, you can show it in GoogleMaps.

image-20220609044824460

Dataset and Adaption

Dataset Description Sensor Link GT Comment
hkust_20201105full image-20221030035547512 vlp16 + stim300+left camera+ normal gps Dropbox, BaiduNetdisk (password: m8g4). GT about 10km outdoor, See this doc.
HILTI DATASET img hesai32+ low-cost imu+5 fisher eye camera Download The config/params_pandar.yaml is prepared for the HILTI sensors kit, so you can run it direcly!
garden_day Garden ouster128 + stim300+ stere camera Download GT indoors. when you download this compressed data, remember to execute the following command, rosbag decompress 20220216_garden_day_ref_compressed.bag

Related Package

  • LIO_SAM 6轴IMU适配香港城市数据集UrbanNav,并给出添加GPS约束和不加GPS约束的结果

Bugs

  1. Call the save map service only when your system optimization is complete, otherwise there will be problems.

TO DO

  1. colored point cloud map
  2. dynamic object removal
  3. GNSS Raw Observations

As soon as I have time I will continue to update this repo and release more data.

Star History

Star History Chart

Acknowledgments

Thanks to Guoqing Zhang, Jianhao JiaoQingwen Zhang.

Thanks to LIO_SAM.

About

LIO_SAM for 6-axis IMU and low-cost GNSS.

Resources

Stars

Watchers

Forks

Packages

No packages published

Languages

  • C++ 90.2%
  • Python 7.3%
  • CMake 1.7%
  • Dockerfile 0.8%