SI_LIO is based on the Invariant-EKF theory and our code is implemented on S-FAST_LIO.
Through theoretical analysis, it can be deduced that our IEKF-based estimation method achieves higher estimation accuracy compared to the Iterated EKF used in FAST-LIO2, particularly in scenarios with large IMU prediction errors. This experimental outcome corroborates our analytical conclusions.
Sophus Eigen PCL livox_ros_driver
Clone the repository and catkin_make:
cd ~/catkin_ws/src
git clone https://github.com/USTC-AIS-Lab/SI-LIO.git
cd ../
catkin_make -j
source ~/catkin_ws/devel/setup.bash
We recommend using the M2DGR dataset.
roslaunch inva_fast_lio mapping_velodyne_m2dgr.launch
rosbag play street_04.bag
Thanks for the authors of S-FAST-LIO and FAST-LIO.