If you would like to enable save map and test localization separately, you can check this repo: SSL_SLAM2

This code is an improved implementation of paper "Lightweight 3-D Localization and Mapping for Solid-State LiDAR", accepted in IEEE Robotics and Automation Letters, 2021

A summary video demo can be found at Video

Modifier: Wang Han, Nanyang Technological University, Singapore

Ubuntu 64-bit 18.04.

ROS Noetic. ROS Installation

Follow Ceres Installation.

Follow PCL Installation.

Tested with 1.8.1

For visualization purpose, this package uses hector trajectory sever, you may install the package by

sudo apt-get install ros-noetic-hector-trajectory-server

Alternatively, you may remove the hector trajectory server node if trajectory visualization is not needed

    cd ~/catkin_ws/src
    git clone https://github.com/wh200720041/ssl_slam3.git
    cd ..
    catkin_make
    source ~/catkin_ws/devel/setup.bash

You may download our recorded data (7.8GB) if you dont have realsense L515, and by defult the file should be under home/user/Downloads unzip the file

cd ~/Downloads
unzip ~/Downloads/library.zip

    roslaunch ssl_slam3 ssl_slam3.launch

If you have new Realsense L515 sensor, you may follow the below setup instructions

You may read official document [L515 Calibration Manual] (https://github.com/l515_calibration_manual.pdf) first

use the following command to calibrate imu, note that the build-in imu is a low-grade imu, to get better accurate, you may use your own imu

cd ~/catkin_ws/src/ssl_slam3/l515_imu_calibration
python rs-imu-calibration.py

Follow Librealsense Installation

Copy realsense_ros package to your catkin folder

    cd ~/catkin_ws/src
    git clone https://github.com/IntelRealSense/realsense-ros.git
    cd ..
    catkin_make

Make Lidar still for 1 sec to estimate the initial bias, otherwise will cause localization failure!

    roslaunch ssl_slam3 ssl_slam3_L515.launch

If you use this work for your research, you may want to cite the paper below, your citation will be appreciated

@article{wang2021lightweight,
  author={H. {Wang} and C. {Wang} and L. {Xie}},
  journal={IEEE Robotics and Automation Letters}, 
  title={Lightweight 3-D Localization and Mapping for Solid-State LiDAR}, 
  year={2021},
  volume={6},
  number={2},
  pages={1801-1807},
  doi={10.1109/LRA.2021.3060392}}