R2DIO: Robust, Real-Time and Depth-Inertial Odometry Based on Multi-Modal Constraints (Intel Realsense L515 as an example)
The RGB-D camera is widely applied on lightweight robots as an essential sensor in indoor SLAM. However, limited by computing cost, many RGB-D SLAM systems do not fully use the multi-modal information of cameras, resulting in degeneration and low accuracy in challenging scenes. To address this issue, this letter introduces a novel, lightweight, robust, real-time and depth-inertial odometry (R2DIO) for ToF RGB-D cameras. Texture and structure information is coupled simultaneously to improve robustness. It efficiently extracts line features from RGB images and plane features from depth images based on agglomerative clustering. When aligning features, the direction vectors of lines and planes are used to filter the mismatches and enhance real-time capability. The IMU measurements propagate states and are tightly coupled in the system by pre-integration. Finally, the system estimates states and builds dense, colored maps with the following constraints: line and plane matching constraints, IMU pre-integration constraints and historical odometry constraints. We demonstrate the robustness, accuracy and efficiency of R2DIO in the experiments. The competitive results indicate that our system is able to locate precisely in challenging scenes and run at 30 Hz on a low-power platform. The source code of R2DIO and experiment datasets is publicly available for the development of the community.
A summary video demo can be found at Youtube and Bilibili.
Author: Xu Jie, Harbin Institute of Technology, China
Ubuntu 64-bit 20.04.
ROS noetic. ROS Installation
Follow Ceres Installation.
Tested with 2.0
Follow PCL Installation.
Tested with 1.10 (inherent in ros)
For visualization purpose, this package uses hector trajectory sever, you may install the package by
sudo apt update
sudo apt install ros-noetic-hector-trajectory-server
Alternatively, you may remove the hector trajectory server node if trajectory visualization is not needed
Tested with 4.2.0 (inherent in ros)
cd ~/catkin_ws/src
git clone https://github.com/jiejie567/R2DIO.git
cd ..
catkin_make
source ~/catkin_ws/devel/setup.bash
You may download our recorded data (10GB). (one rosbag)
If you are in China, you can download the recorded data via Baidu Netdisk : office, hall, and display board. The extraction code is 0503. (ten rosbags)
Note that due to the limitation of Google drive capacity, we only upload one rosbag.
roslaunch r2dio r2dio.launch
Note that change the path to your datasets.
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/r2dio/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 r2dio r2dio_L515.launch
You can see the details in docker_support.pdf. Thanks for Yin Ao's work about the docker.
If you use this work for your research, you may want to cite the paper below, your citation will be appreciated. The following is Wang Han's paper temporarily, we will update our paper as soon as our paper being accepted.
@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}}
The code is heavily derived from SSL-SLAM3, thanks for Wang Han's open-source spirit.
The datasets and video are processed by Qiu Shuxin and Huang Song.
The docker is created by Yin Ao.
What's more, the "DIO" in the title "R2DIO" means: