FAST LIO with a Loop Closure Module

[code] [video]

这个项目是在参加一个机器人比赛时测试使用的定位方案,针对FAST-LIO没有回环检测这个问题,在此基础上添加了radius-search-based loop closure detection module来减小累积误差。