分享

LOG-LIO: 一种高效局部几何信息估计的激光雷达惯性里程计方法

 点云PCL 2023-08-09 发布于上海

文章:LOG-LIO: A LiDAR-Inertial Odometry with Efficient Local Geometric Information Estimation

作者:Kai Huang , Junqiao Zhao , Tiantian Feng , Zhongyang Zhu , Chen Ye

编辑:点云PCL

代码:https://github.com/tiev-tongji/LOG-LIO

欢迎各位加入知识星球,获取PDF论文,欢迎转发朋友圈。文章仅做学术分享,如有侵权联系删文。

公众号致力于点云处理,SLAM,三维视觉,高精地图等领域相关内容的干货分享,欢迎各位加入,有兴趣的可联系dianyunpcl@163.com。未经作者允许请勿转载,欢迎各位同学积极分享和交流。

摘要

局部几何信息即法线和点分布在基于激光雷达的同时定位与地图构建(SLAM)中是至关重要,因为它为数据关联提供了约束,进一步确定了优化方向,最终影响姿态的准确性。然而即使在使用KD树或体素图的辅助下,估计法线和点分布也是耗时的任务。为了实现快速法线估计,我们研究了激光雷达扫描帧的结构信息,提出了一种新颖的快速近似最小二乘(FALS)方法,通过预先计算的方位角信息,当新的扫描帧到达时,估计法线仅需要点的距离信息,为了高效估计点的分布,我们将ikd树扩展到体素管理地图,并在保持法线一致性的同时增量更新其点云分布。对于满足基于法线的可见性和一致性检查的扫描点,我们设计了一种稳健且准确的分层数据关联方案,其中点到曲面的关联优先于点到平面的关联,在分布趋于收敛后,我们进一步固定体素以平衡时间消耗和表示的正确性,在多样的公开数据集上进行的大量实验表明,与其他先进方法相比,我们的系统具有明显优势。

主要贡献

地图体素内逐步更新点云分布以保持空间信息的正确性,同时与法线保持一致性。为了平衡时间消耗和表示的正确性,我们在扩展的ikd树上管理地图,并在分布收敛后进一步固定分布。本工作的主要贡献如下:

  • Ring FALS一种利用特定激光雷达的结构信息的新型快速近似最小二乘法法线估计器,与PCL相比快速而准确,满足LIO系统的实时要求。

  • 考虑地图体素内点分布的鲁棒且准确的分层数据关联方案,其中点到曲面的关联优先于点到平面的关联,大尺度优先于小尺度。

  • 对公共数据集进行广泛实验,证明我们的LIO系统相对于其他最先进的方法具有优势。为了使社区受益,该工作实现已在

    https://github.com/tiev-tongji/LOG-LIO 开源,还将Ring FALS作为独立的法线工具开源在

    https://github.com/tiev-tongji/RingFalsNormal。

主要内容

LOG-LIO的流程接收来自3D激光雷达和惯性测量单元(IMU)的输入,如图2所示。对于新的输入扫描,我们首先使用Ring FALS来估计原始点的法线,在使用IMU测量校正畸变后,根据它们的局部几何信息,在未畸变的点云和地图之间执行关联。我们通过iEKF整合IMU的测量,并通过类似FAST-LIO的方法优化机体的姿态,在优化之后,新的点被添加到由扩展的ikd树管理的地图中,地图体素内的分布在考虑法线的同时进行增量维护,以确保其准确性,并在收敛后进行固定。

图2. LOG-LIO系统概述

图3. 白色线条表示来自 Ring FALS 估计的法线

实验

表 I 显示了用于 M2DGR 和 NTU VIRAL 数据集中 Velodyne-32 LiDAR 的单次扫描的平均法线估计处理时间。对于 Velodyne-32 LiDAR 的单次扫描约有 57,600 个点,与 PCL 相比,Ring FALS 的耗时仅为十分之一,与 OMP 版本相比甚至只有四分之一。对于 Ouster16 LiDAR,无论是单线程还是 OMP 版本,Ring FALS 的时间消耗都远小于 PCL,分析 PCL 的结果,尽管 Ouster-16 LiDAR 的点数少于 Velodyne-32,但耗时反而增加,原因是 PCL 法线估计中最耗时的部分之一是 KDtree 邻域搜索,这与 KDtree 的结构有关。

表格 II 报告了实验结果,可以看出,在室内场景中,LOG、LOG-C 和 FAST-LIO2 的轨迹准确性接近,并在大多数序列中优于 LIO-SAM。

图4显示了数据集street10 的轨迹,进行了定性比较,LOG 的出色表现证明与稀疏点场景中的地图体素关联更好地表示了局部几何信息。

图4. M2DGR 数据集序列 street10 中的定位估计,放大的彩色框图像对应于轨迹中相同颜色的框。

LOG-LIO 在大多数实验中获得最佳结果,紧随其后的是 FAST-LIO2,而由于 LiDAR 点云和地图的稀疏性,LIO-SAM 更容易失败,如表格 III 所示

每个序列中 LOG-LIO 和 FAST-LIO2 的平均耗时,如表 IV 所示。

总结

本文提出的LOG-LIO是一种在线激光雷达惯性里程计法,它结合实时的法线和点分布估计来准确表示局部几何信息。同时还提出了一种高效的激光雷达点云法线估计方法,名为 Ring FALS,它预先计算了方位信息并仅利用距离信息来估计点的法线,LOG-LIO 通过扩展的 ikd-tree 管理地图,并在地图体素内逐步维护法线和点分布,分层数据关联方案提供了精确的约束,从而实现更准确的姿态估计,在各种环境中,LOG-LIO 在实验中表现出色,优于现有的 LIO 系统。

资源

自动驾驶及定位相关分享

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

自动驾驶中基于光流的运动物体检测

基于语义分割的相机外参标定

综述:用于自动驾驶的全景鱼眼相机的理论模型和感知介绍

高速场景下自动驾驶车辆定位方法综述

Patchwork++:基于点云的快速、稳健的地面分割方法

PaGO-LOAM:基于地面优化的激光雷达里程计

多模态路沿检测与滤波方法

多个激光雷达同时校准、定位和建图的框架

动态的城市环境中杆状物的提取建图与长期定位

非重复型扫描激光雷达的运动畸变矫正

快速紧耦合的稀疏直接雷达-惯性-视觉里程计

基于相机和低分辨率激光雷达的三维车辆检测

用于三维点云语义分割的标注工具和城市数据集

ROS2入门之基本介绍

固态激光雷达和相机系统的自动标定

激光雷达+GPS+IMU+轮速计的传感器融合定位方案

基于稀疏语义视觉特征的道路场景的建图与定位

自动驾驶中基于激光雷达的车辆道路和人行道实时检测(代码开源)

用于三维点云语义分割的标注工具和城市数据集

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

SLAM及AR相关分享

TOF相机原理介绍

TOF飞行时间深度相机介绍

结构化PLP-SLAM:单目、RGB-D和双目相机使用点线面的高效稀疏建图与定位方案

开源又优化的F-LOAM方案:基于优化的SC-F-LOAM

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

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

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

SLAM和AR综述

常用的3D深度相机

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

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

Kimera实时重建的语义SLAM系统

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

易扩展的SLAM框架-OpenVSLAM

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

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

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

扫描二维码

                   关注我们

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

    转藏 分享 献花(0

    0条评论

    发表

    请遵守用户 评论公约

    类似文章