FAST-LIO2:快速直接的激光雷达与惯导里程计

点云PCL免费知识星球,点云论文速读。

文章:FAST-LIO2: Fast Direct LiDAR-inertial Odometry

作者: Wei Xu∗1 , Yixi Cai∗1 , Dongjiao He1 , Jiarong Lin1 , Fu Zhang

编译:点云PCL

代码:https://github.com/hku-mars/FAST_LIO

来源:arxiv2021

欢迎各位加入免费知识星球,获取PDF论文,欢迎转发朋友圈。文章仅做学术分享,如有侵权联系删文。未经博主同意请勿擅自转载。

论文阅读模块将分享点云处理,SLAM,三维视觉,高精地图相关的文章。公众号致力于理解三维视觉领域相关内容的干货分享,欢迎各位加入我,我们一起每天一篇文章阅读,开启分享之旅,有兴趣的可联系微信dianyunpcl@163.com。

摘要

本文介绍了FAST-LIO2:一种快速、鲁棒的、通用的激光雷达惯性里程计框架,FASTLIO2以高效紧耦合的方式迭代卡尔曼滤波器为基础,具有两个关键的新颖之处,可实现快速、稳健和精确的激光雷达的建图和导航。

第一种方法是将原始点云直接配准到地图上(然后更新地图),而不提取特征,这样就可以利用环境中的精细特征来提高精度。这里不使用人工设计的特征提取模块。让它自然适应不同扫描模式的新激光雷达。

[En]

The first method is to directly register the original point cloud to the map (then update the map) without extracting features, so that the fine features in the environment can be used to improve the accuracy. The artificially designed feature extraction module is not used here. Make it naturally adapt to the new lidar with different scanning modes.

第二个主要创新点是通过增量k-d树数据结构kd-tree来维护地图,该结构支持增量更新(即点插入、删除)和动态平衡。与现有的动态数据结构(八叉树,R-树,nanoflann k-d树),kd树实现了卓越的整体性能,同时自然支持下采样,我们对来自各种开放式激光雷达数据集的19个序列进行了详尽的基准比较。FAST-LIO2比其他最先进的激光雷达惯性导航系统低得多的计算量实现了持续更高的精度,在小视场的固态激光雷达上也进行了各种真实世环境的实验,总体而言,FAST-LIO2计算效率高,鲁棒性强,多功能,同时仍能实现比现有方法更高的精度,FAST-LIO2和数据结构kd树的实现都是在Github上开源了。

https://github.com/hku-mars/FAST_LIO

主要贡献

在这项工作中,贡献如下:

1)开发了一种增量k-d树数据结构ikd树,以高效地表示大型稠密点云地图,除了高效的最近邻搜索外,新的数据结构还支持增量地图更新(即点插入、下采样、点删除)和以最小计算成本进行动态平衡。这些功能使ikd树非常适合于激光雷达里程计和地图应用,从而在计算训练平台上实现100 Hz里程计和建图,ikdTree数据结构工具箱在Github上是开源的( https://github.com/hku-mars/ikd-Tree )

2) 由于ikd树计算效率的提高,我们直接将原始点云配准到地图上,这样即使在剧烈运动和非常混乱的环境中,也能实现更精确和可靠的点云配准,我们将这种基于原始点的配准称为直接方法,消除了人工设计的特征提取,使系统自然适用于不同的激光雷达传感器;

3) 将这两项关键技术集成到我们最近开发的紧耦合激光雷达惯性里程计系统FAST-LIO中,系统使用IMU通过严格的反向传播步骤补偿每个点云的运动,并通过流形迭代卡尔曼滤波器估计系统的完整状态,为了进一步加快计算速度,使用了一个新的、数学上等价的卡尔曼增益计算公式,将计算复杂度降低到状态的维度,新系统被称为FAST-LIO2,并在Github开源以造福社区;

4) 作者进行了各种实验来评估开发的ikd树、直接点云配准和整个系统的有效性,在18个不同大小的序列上的实验表明,ikdTree相对于现有的动态数据结构在激光雷达里程计和建图中的应用,对来自各种开放式激光雷达数据集的19个序列进行了详尽的基准比较,结果表明FAST-LIO2以比其他最先进的激光雷达惯性导航系统低得多的计算量实现了更高的精度,最后,文章展示了FAST-LIO2对新兴固态激光雷达收集的具有挑战性的现实世界数据的有效性,这些数据的FoV非常小,包括剧烈运动和无结构环境中。

主要内容

FAST-LIO2:快速直接的激光雷达与惯导里程计

图1 系统概述

FAST-LIO2的状态估计是从FAST-LIO继承的紧耦合迭代卡尔曼滤波器,FAST-LIO2的流程如图1所示,顺序采样的激光雷达原始点首先在10ms(用于100Hz更新)和100ms(用于10Hz更新)之间的时间段内累积。累积的点云称为扫描数据,为了执行状态估计,新扫描中的点云通过紧耦合迭代卡尔曼滤波框架配准到大型局部地图中维护的地图点(即里程计),大型局部地图中的全局地图点由增量k-d树结构ikd树组织。如果当前激光雷达的视场范围穿过地图边界,则距离激光雷达姿态最远的地图区域中的历史点将从ikd树中删除,因此,ikd树以一定长度(本文中称为”地图大小”)跟踪大立方体区域中的所有地图点,并用于在状态估计模块中计算残差。优化姿势最终将新扫描中的点云配准到全局帧,并通过以里程计的速率插入ikd树,将其合并到地图中。(更详细的模块介绍请查看https://t.zsxq.com/z7YBqzj)

开源方案涉及到的依赖项

ikd树:用于3D kNN搜索的最先进的动态KD树。

IKFOM:用于快速高精度流形卡尔曼滤波器的工具箱。

UAV Avoiding Dynamic Obstacles:FAST-LIO在机器人规划中的实现之一。

R2LIVE:使用FAST-LIO作为激光雷达惯性前端的高精度激光雷达惯性视觉融合工作。

UGV Demo:微分流形上轨迹跟踪的模型预测控制。

FAST-LIO-SLAM:FAST-LIO与点云上下文闭环检测模块的集成。

FAST-LIO-LOCALIZATION:FAST-LIO与重定位功能模块的集成。

实验

A 数据结构评估

增量更新、kNN搜索和总时间的每次扫描点云平均消耗时间的比较

FAST-LIO2:快速直接的激光雷达与惯导里程计

不同树大小的数据结构比较结果

FAST-LIO2:快速直接的激光雷达与惯导里程计

B 在数据集中的精度评估

具有高质量真值的序列中的绝对平移误差(RMSE,单位为米)

FAST-LIO2:快速直接的激光雷达与惯导里程计

FAST-LIO2:快速直接的激光雷达与惯导里程计

C 大规模环境中建图评估

每帧扫描点云基准的平均处理时间(毫秒)

FAST-LIO2:快速直接的激光雷达与惯导里程计

大规模场景下的建图效果

FAST-LIO2:快速直接的激光雷达与惯导里程计

处理激光雷达点云时单个模块的平均时间消耗(毫秒)

FAST-LIO2:快速直接的激光雷达与惯导里程计

总结

本文提出了FAST-LIO2,这是一个直接而鲁棒的LIO框架,大大优于目前最先进的LIO算法,同时在各种数据集中实现了高效率或更好的精度,速度的提高是由于删除了特征提取模块和高效建图,开发并验证了一种新的增量k-d树(ikd-tree)数据结构,该结构支持动态点插入、删除和并行建图,在开放数据集上的大量实验表明,在激光雷达里程计kNN搜索的最新数据结构中,所提出的ikd树可以获得最佳的整体性能。作为建图效率的结果,在快速运动和稀疏场景中,通过在里程计中使用更多的点,精度和鲁棒性也得到了提高。FAST-LIO2的另一个好处是由于去除了特征提取,可适用于不同的激光雷达。

资源

三维点云论文及相关应用分享


更多文章可查看:

SLAM及AR相关分享


扫描下方 微信视频号二维码可查看最新研究成果及相关开源方案的演示:

如果你对本文感兴趣,请点击”原文阅读”获取知识星球二维码,务必按照”姓名+学校/公司+研究方向”备注加入免费知识星球,免费下载pdf文档,和更多热爱分享的小伙伴一起交流吧!

如果以上内容有任何错误,请留言,欢迎更正交流。如有侵权行为,请联系删除

[En]

If there are any mistakes in the above content, please leave a comment, welcome to correct the communication. If there is any infringement, please contact to delete

扫描二维码

关注我们

让我们一起分享和学习吧。期待点子,愿意分享的朋友加入自由星球,为分享注入爱的新鲜活力。共享的主题包括但不限于3D视觉、点云、高精度地图、自动驾驶和机器人。

[En]

Let’s share and study together. Look forward to the idea, willing to share friends to join the free planet to inject the fresh vitality of love sharing. Shared topics include, but are not limited to, 3D vision, point clouds, high-precision maps, autopilot, and robots.

分享及合作:群主微信”920177957″(需要按要求备注) 联系邮箱:dianyunpcl@163.com,欢迎企业来联系公众号展开合作。

点一下”在看”你会更好看耶

FAST-LIO2:快速直接的激光雷达与惯导里程计

Original: https://blog.csdn.net/u013019296/article/details/122552014
Author: Being_young
Title: FAST-LIO2:快速直接的激光雷达与惯导里程计

原创文章受到原创版权保护。转载请注明出处:https://www.johngo689.com/30408/

转载文章受原作者版权保护。转载请注明原作者出处!

(0)

大家都在看

发表回复

登录后才能评论
免费咨询
免费咨询
扫码关注
扫码关注
联系站长

站长Johngo!

大数据和算法重度研究者!

持续产出大数据、算法、LeetCode干货,以及业界好资源!

2022012703491714

微信来撩,免费咨询:xiaozhu_tec

分享本页
返回顶部