文章: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树上管理地图,并在分布收敛后进一步固定分布。本工作的主要贡献如下:
主要内容 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点云地图中的定位方法 自动驾驶中基于激光雷达的车辆道路和人行道实时检测(代码开源) 更多文章可查看:点云学习历史文章大汇总 SLAM及AR相关分享 以上内容如有错误请留言评论,欢迎指正交流。如有侵权,请联系删除 扫描二维码 关注我们 让我们一起分享一起学习吧!期待有想法,乐于分享的小伙伴加入知识星球注入爱分享的新鲜活力。分享的主题包含但不限于三维视觉,点云,高精地图,自动驾驶,以及机器人等相关的领域。 |
|