arXiv:2410.14565cs.RO2024-10

提出PSS-GOSO方法,提升大规模激光雷达捆绑调整的精度与效率。

Graph Optimality-Aware Stochastic LiDAR Bundle Adjustment with Progressive Spatial Smoothing

  • 利用结构先验和渐进空间平滑提取鲁棒特征关联
  • 通过图最优性稀疏化与随机聚类实现高效优化
  • 适合大场景物流机器人导航,支持复杂环境自动配送

大规模激光雷达捆绑调整(LBA)可同时优化传感器位姿与点云精度,构建导航地图,是物流与机器人领域的基础任务。与仅依赖帧间关系的位姿图方法不同,LBA利用原始激光雷达对应关系,能在初始位姿估计不可靠时仍获得更精确结果,尤其适用于低成本传感器。然而现有LBA方法存在平面对应关系简单、观测量过大、最小二乘问题中法向矩阵稠密等问题,制约了其鲁棒性、效率与可扩展性。为此,本文提出一种图最优性感知的随机优化方案——渐进空间平滑图优化(PSS-GOSO),实现鲁棒、高效、可扩展的LBA。其中,渐进空间平滑(PSS)模块利用多项式平滑核获取的先验结构信息,提取鲁棒的激光雷达特征关联;图最优性感知随机优化(GOSO)模块首先根据最优性对图进行稀疏化以提高效率,再通过随机聚类与图边缘化解决大规模状态估计问题,实现可扩展的LBA。我们在多种平台采集的多样化场景中验证了PSS-GOSO,结果优于现有方法。此外,生成的点云地图被用于大场景复杂环境中的自动最后一公里配送。项目主页见:https://kafeiyin00.github.io/PSS-GOSO/

原文摘要 · Abstract (English)

Large-scale LiDAR Bundle Adjustment (LBA) to refine sensor orientation and point cloud accuracy simultaneously to build the navigation map is a fundamental task in logistics and robotics. Unlike pose-graph-based methods that rely solely on pairwise relationships between LiDAR frames, LBA leverages raw LiDAR correspondences to achieve more precise results, especially when initial pose estimates are unreliable for low-cost sensors. However, existing LBA methods face challenges such as simplistic planar correspondences, extensive observations, and dense normal matrices in the least-squares problem, which limit robustness, efficiency, and scalability. To address these issues, we propose a Graph Optimality-aware Stochastic Optimization scheme with Progressive Spatial Smoothing, namely PSS-GOSO, to achieve \textit{robust}, \textit{efficient}, and \textit{scalable} LBA. The Progressive Spatial Smoothing (PSS) module extracts \textit{robust} LiDAR feature association exploiting the prior structure information obtained by the polynomial smooth kernel. The Graph Optimality-aware Stochastic Optimization (GOSO) module first sparsifies the graph according to optimality for an \textit{efficient} optimization. GOSO then utilizes stochastic clustering and graph marginalization to solve the large-scale state estimation problem for a \textit{scalable} LBA. We validate PSS-GOSO across diverse scenes captured by various platforms, demonstrating its superior performance compared to existing methods. Moreover, the resulting point cloud maps are used for automatic last-mile delivery in large-scale complex scenes. The project page can be found at: \url{https://kafeiyin00.github.io/PSS-GOSO/}.

激光雷达捆绑调整机器人导航优化算法

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。