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

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,三维视觉,高精地图相关的文章。公众号致力于理解三维视觉领域相关内容的干货分享,欢迎各位加入我,我们一起每天一篇文章阅读,开启分享之旅,有兴趣的可联系微信[email protected]

摘要

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

第一该方法是直接将原始点云配准到地图(随后更新地图),而不提取特征,这样可以利用环境中的细微特征,从而提高准确性,这里不采用人工设计的特征提取模块,使其自然适应不同扫描模式的新兴激光雷达;

第二个主要创新点是通过增量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非常小,包括剧烈运动和无结构环境中。

主要内容

ef3ef414fcba654cfb55fa0e39e2b8ab.png

  图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搜索和总时间的每次扫描点云平均消耗时间的比较

ff8740e3d578e1f463610e81be6d27b6.png

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

6816dcbeda0efcf90ebf63b9bf635c95.png

B 在数据集中的精度评估

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

e8038dbda50c897a2d612fe999a29b82.png

f964c3f58489e00551daa5b10f7e90d2.png

C 大规模环境中建图评估

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

ac71d8d870eaad3d665b0988f18d34e6.png

大规模场景下的建图效果

e35ddb28c4792b55f403f0c133a01ea2.png

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

5c0befe0db4b179341e7d5e46fb6a507.png

总结

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

资源

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

【点云论文速读】基于激光雷达的里程计及3D点云地图中的定位方法

3D目标检测:MV3D-Net

三维点云分割综述(上)

3D-MiniNet: 从点云中学习2D表示以实现快速有效的3D LIDAR语义分割(2020)

win下使用QT添加VTK插件实现点云可视化GUI

JSNet:3D点云的联合实例和语义分割

大场景三维点云的语义分割综述

PCL中outofcore模块---基于核外八叉树的大规模点云的显示

基于局部凹凸性进行目标分割

基于三维卷积神经网络的点云标记

点云的超体素(SuperVoxel)

基于超点图的大规模点云分割

更多文章可查看:点云学习历史文章大汇总

SLAM及AR相关分享

【开源方案共享】ORB-SLAM3开源啦!

【论文速读】AVP-SLAM:自动泊车系统中的语义SLAM

【点云论文速读】StructSLAM:结构化线特征SLAM

SLAM和AR综述

常用的3D深度相机

AR设备单目视觉惯导SLAM算法综述与评价

SLAM综述(4)激光与视觉融合SLAM

Kimera实时重建的语义SLAM系统

SLAM综述(3)-视觉与惯导,视觉与深度学习SLAM

易扩展的SLAM框架-OpenVSLAM

高翔:非结构化道路激光SLAM中的挑战

SLAM综述之Lidar SLAM

基于鱼眼相机的SLAM方法介绍

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

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

以上内容如有错误请留言评论,欢迎指正交流。如有侵权,请联系删除

扫描二维码

                   关注我们

让我们一起分享一起学习吧!期待有想法,乐于分享的小伙伴加入免费星球注入爱分享的新鲜活力。分享的主题包含但不限于三维视觉,点云,高精地图,自动驾驶,以及机器人等相关的领域。

分享及合作:群主微信“920177957”(需要按要求备注) 联系邮箱:[email protected],欢迎企业来联系公众号展开合作。

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

2cd74e9ecc39d065e0abaad0428aba59.gif

更多相关:

  • 点云PCL免费知识星球,点云论文速读。文章:Towards High-Performance Solid-State-LiDAR-Inertial Odometry and Mapping作者:Kailai Li, Meng Li, and Uwe D. Hanebeck编译:点云PCL代码:https://github.com/K...

  • 论文阅读模块将分享点云处理,SLAM,三维视觉,高精地图相关的文章。公众号致力于理解三维视觉领域相关内容的干货分享,欢迎各位加入我,我们一起每天一篇文章阅读,开启分享之旅,有兴趣的可联系微信[email protected]。mlcc介绍本文主要实战应用这篇文章的代码,https://github.com/hku-mars/mlc...

  • 标题:3D Vehicle Detection Using Camera and Low-Resolution LiDAR Zhang, Rui Huang, Le Cui, Siyu Zhu, and Ping Tan作者:Lin Bai, Yiming Zhao and Xinming Huang编译:点云PCL本文仅做学术分享...

  • 标题:VCamVox: A Low-cost and Accurate Lidar-assisted Visual SLAM System作者:Yuewen Zhu, Chunran Zheng, Chongjian Yuan, Xu Huang and Xiaoping Hong来源:分享者代码:https://github.co...

  • 点云PCL免费知识星球,点云论文速读。标题:三维点云分割综述(上)排版:particle欢迎各位加入免费知识星球,获取PDF文档,欢迎转发朋友圈,分享快乐。这是一篇综述性论文,以下只做概述性介绍,介绍文章已共享在微信群和免费知识星球中,文章在公众号将分成三个部分:第一部分介绍点云的获取以及各种传感器获取点云的特性,以及分割概念的区别...

  • 点云PCL免费知识星球,点云论文速读。文章:DLL: Direct LIDAR Localization. A map-based localization approach for aerial robots作者:Fernando Caballero1 and Luis Merino编译:点云PCL代码:https://githu...

  • CloudCompare是一个三维点云(网格)编辑和处理软件。最初,它被设计用来对稠密的三维点云进行直接比较。它依赖于一种特定的八叉树结构,在进行点云对比这类任务时具有出色的性能【1】。此外,由于大多数点云都是由地面激光扫描仪采集的,CloudCompare的目的是在一台标准笔记本电脑上处理大规模的点云——通常超过1000万个点云。...

  • 点云PCL免费知识星球,点云论文速读。文章:Open3DGen: Open-Source Software for Reconstructing Textured 3D Models from RGB-D Images作者:Teo T. Niemirepo, Marko Viitanen, and Jarno Vanne编译:点云P...

  • 点云PCL免费知识星球,点云论文速读。标题:Real-Time Spatio-Temporal LiDAR Point Cloud Compression作者:Yu Feng , Shaoshan Liu , and Yuhao Zhu来源:2020IROS本文仅做学术分享,如有侵权,请联系删除。欢迎各位加入免费知识星球,获取PDF...