当前位置:   article > 正文

SLAM经典:FSAT-LIO算法梳理

fastlio

点击上方“3D视觉工坊”,选择“星标”

干货第一时间送达

1d9ce6779ae732f2324b6330d9aa6bca.jpeg

编辑丨一点人工一点智能

点击进入—>3D视觉工坊学习交流群

今天给大家分享IEEE Robotics and Automation Letters上发表经典文章:FAST-LIO: A Fast, Robust LiDAR-inertial Odometry Package by Tightly-Coupled Iterated Kalman Filter。文章中主要介绍了香港大学火星实验室研发的一种SLAM算法—FAST-LIO。

08bd95fda84b7e978f8e9854f78af27f.png

论文地址:https://arxiv.org/abs/2010.08196v3

01  背景介绍

SLAM是随着机器人的发展而衍生出的一个概念,为的是解决机器人的自主定位和导航问题,现在已经被广泛应用在汽车自动驾驶、无人机、测绘以及AR和VR方面。SLAM又有激光SLAM和视觉SLAM之分,其主要区别是所用传感器和获取数据不同。FAST-LIO算法就是属于激光SLAM。

02  问题与方法

早在FAST-LIO之前,就已经出现了许多经典的激光SLAM算法,例如LOAM、 LeGO-LOAM等等,但文章的作者他们慢慢发现这些算法都或多或少得存在以下局限性:

1)激光雷达测量中的特征点通常是环境中的几何结构(例如,边缘和平面)。当无人机在杂乱的环境中工作时,由于没有强有力的特征,基于激光雷达的解决方案很容易发生退化。在激光雷达只具有小视场的时候,这个问题更加明显。

2)由于沿着扫描方向的高分辨率,激光雷达扫描通常包含许多特征点。虽然这些特征点并不能保证在发生退化的情况下可靠地确定姿态,但是将这些大量的特征点融合到IMU测量中依旧需要巨大的计算资源,这是UAV机载计算机难以负担的。

3)由于激光雷达通过多个激光器/接收器进行采样点,扫描中的激光点无法保证在同一时间采样,这会导致出现运动失真,也将显著降低扫描配准。另外,无人机螺旋桨和电机的持续旋转也给IMU测量带来了明显的噪声。

为了解决以上问题,文章中采取了以下方法:

1)为了应对发生退化的快速运动、噪声或杂乱环境,文章中采用紧耦合迭代卡尔曼滤波器来融合激光雷达特征点和IMU测量。

2)为了降低大量激光雷达特征点带来的巨大计算量,文章中提出了一种新的卡尔曼增益计算公式,并证明了它与传统卡尔曼增益公式的等价性。新公式的计算复杂度取决于状态维数而不是测量维数。

3)文章提出了一个反向传播过程来补偿激光雷达采样时带来的运动失真。

03  算法

FAST-LIO算法的整个过程如下图所示。在建图过程中,首先将激光雷达输入数据输入到特征提取模块,以此来获得平面特征和边缘特征。然后将提取的特征和IMU测量值输入到状态估计模块,在10Hz−50Hz下进行状态估计。之后,估计的姿态将特征点注册到全局框架中,并将它们与到目前为止构建的特征点图合并。更新后的地图会在下一步中加入更多新的点。与过去的算法明显不同的是,在IMU的状态估计模块中增加了反向传播的过程,并将反向传播所得的结果与正向传播所得结果一起输入到剩余计算中去。这其中各个部分涉及的大量数学推导,感兴趣的朋友可以去自行阅读原文。

f6434cac6cb59d55bc79137dcb481c11.png

04  实验

文章的作者们为了验证FAST-LIO的卓越性,分别进行了三个实验。

在第一个实验中,他们在其他条件不变得情况下分别使用新、旧得卡尔曼增益计算公式,并比较了最终的的计算时间和特征点的数量。结果如表所示,事实证明,新的卡尔曼增益计算公式确实可以很好地减少计算量和计算时间

9c689834a1b784d422c4ef4cb563080d.png

在第二个实验中,作者们将搭载了FAST-LIO算法的无人机置于室内进行飞行测试。并与LOAM算法进行比较。测试结果表明,FAST-LIO的运算速度更快、更稳定。其实验过程中无人机飞行的角速度和加速度以及最终比较结果如下图所示。

6547b67012f4fdfd8d17f994f1681fae.png

在第三个实验中,作者们将搭载了FAST-LIO算法的无人机置于室外进行飞行测试。最终该实验中的漂移率小于0.05% (在140米轨道上漂移0.07米)。该实验将扫描速率设置为 10 Hz,一次扫描的平均处理时间为25 ms,平均有1497个有效特征点。该实验对香港大学主楼的测绘结果如下图所示。

e5169bc46af559cebc822b6b7713c4e8.png

05  总结

这篇文章提出了一种基于紧耦合迭代卡尔曼滤波器的激光雷达惯性测程框架。该框架使用正向和反向传播来预测状态和补偿激光雷达扫描中的运动。此外,文章中证明并实现了一个复杂度更低,但与卡尔曼增益计算等效的公式。最后,所有的测试都证明,该算法可以提供精确、实时和可靠的导航结果。

本文仅做学术分享,如有侵权,请联系删文。

点击进入—>3D视觉工坊学习交流群

干货下载与学习

后台回复:巴塞罗自治大学课件,即可下载国外大学沉淀数年3D Vison精品课件

后台回复:计算机视觉书籍,即可下载3D视觉领域经典书籍pdf

后台回复:3D视觉课程,即可学习3D视觉领域精品课程

3D视觉工坊精品课程官网:3dcver.com

1.面向自动驾驶领域的3D点云目标检测全栈学习路线!(单模态+多模态/数据+代码)
2.彻底搞透视觉三维重建:原理剖析、代码讲解、及优化改进
3.国内首个面向工业级实战的点云处理课程
4.激光-视觉-IMU-GPS融合SLAM算法梳理和代码讲解
5.彻底搞懂视觉-惯性SLAM:基于VINS-Fusion正式开课啦
6.彻底搞懂基于LOAM框架的3D激光SLAM: 源码剖析到算法优化
7.彻底剖析室内、室外激光SLAM关键算法原理、代码和实战(cartographer+LOAM +LIO-SAM)

8.从零搭建一套结构光3D重建系统[理论+源码+实践]

9.单目深度估计方法:算法梳理与代码实现

10.自动驾驶中的深度学习模型部署实战

11.相机模型与标定(单目+双目+鱼眼)

12.重磅!四旋翼飞行器:算法与实战

13.ROS2从入门到精通:理论与实战

14.国内首个3D缺陷检测教程:理论、源码与实战

15.基于Open3D的点云处理入门与实战教程

16.透彻理解视觉ORB-SLAM3:理论基础+代码解析+算法改进

17.机械臂抓取从入门到实战

重磅!粉丝学习交流群已成立

交流群主要有3D视觉、CV&深度学习、SLAM、三维重建、点云后处理、自动驾驶、多传感器融合、CV入门、三维测量、VR/AR、3D人脸识别、医疗影像、缺陷检测、行人重识别、目标跟踪、视觉产品落地、视觉竞赛、车牌识别、硬件选型、ORB-SLAM系列源码交流、深度估计、TOF、求职交流等方向。

扫描以下二维码,添加小助理微信(dddvisiona),一定要备注:研究方向+学校/公司+昵称,例如:”3D视觉 + 上海交大 + 静静“。请按照格式备注,可快速被通过且邀请进群。原创投稿也请联系。

ebeb6fc9dba6beae7dbe7f2771291288.jpeg

▲长按加微信群或投稿,微信号:dddvisiona

3D视觉从入门到精通知识星球:针对3D视觉领域的视频课(三维重建系列、三维点云系列、结构光系列、手眼标定、相机标定、激光/视觉SLAM、自动驾驶等)源码分享、知识点汇总、入门进阶学习路线、最新paper分享、疑问解答等进行深耕,更有各类大厂的算法工程人员进行技术指导。与此同时,星球将联合知名企业发布3D视觉相关算法开发岗位以及项目对接信息,打造成集技术与就业为一体的铁杆粉丝聚集区,6000+星球成员为创造更好的AI世界共同进步,知识星球入口:

学习3D视觉核心技术,扫描查看,3天内无条件退款

8c389aa6f99d020bc245cc156d872f15.jpeg

高质量教程资料、答疑解惑、助你高效解决问题

觉得有用,麻烦给个赞和在看~  

本文内容由网友自发贡献,转载请注明出处:https://www.wpsshop.cn/w/盐析白兔/article/detail/481559
推荐阅读
相关标签
  

闽ICP备14008679号