arXivDaily arXiv每日学术速递 周一至周五更新
arXiv周末暂无论文更新,休息一下吧,周末愉快~~
arXiv 2303.00216cs.RO
收藏

基于重要性采样融合测量模型优化的三维LiDAR-based Monte Carlo定位算法

Efficient Solution to 3D-LiDAR-based Monte Carlo Localization with Fusion of Measurement Model Optimization via Importance Sampling

Nagoya University(名古屋大学);LOCT Co., Ltd.(LOCT株式会社)

Naoki Akai

摘要:

本文提出了一种基于3D-LiDAR的蒙特卡罗定位(MCL)的有效解决方案。如果粒子在地面真实值周围被精确采样,MCL就能鲁棒地工作。惯性导航系统(INS)可以用于精确采样,但仍然需要使用许多粒子来解决三维定位问题,即使INS是可用的。特别是,如果INS不可用,则需要大量的粒子,并且就计算成本而言,执行3D MCL是不可行的。扫描匹配(SM),即基于优化的定位,即使INS不可用也有效地工作,因为SM可以在其优化过程中忽略机器人和/或设备的移动约束。然而,SM有时确定不可行的估计对运动。我们认为MCL和SM具有互补的优点和缺点,并提出了一种MCL和SM的融合方法。因为SM被认为是在概率建模方面的测量模型的优化,所以我们执行测量模型优化作为SM。然后,使用优化结果来近似测量模型分布,并且使用近似的分布来对颗粒进行采样。通过重要性采样将采样粒子与MCL融合。因此,可以同时利用MCL和SM的优点,同时减轻它们的缺点。在KITTI数据集和其他两个开放数据集上进行了实验。结果表明,该方法可以在单CPU线程上运行,即使在INS不可用的情况下也能准确地执行定位。

英文摘要:

This paper presents an efficient solution to 3D-LiDAR-based Monte Carlo localization (MCL). MCL robustly works if particles are exactly sampled around the ground truth. An inertial navigation system (INS) can be used for accurate sampling, but many particles are still needed to be used for solving the 3D localization problem even if INS is available. In particular, huge number of particles are necessary if INS is not available and it makes infeasible to perform 3D MCL in terms of the computational cost. Scan matching (SM), that is optimization-based localization, efficiently works even though INS is not available because SM can ignore movement constraints of a robot and/or device in its optimization process. However, SM sometimes determines an infeasible estimate against movement. We consider that MCL and SM have complemental advantages and disadvantages and propose a fusion method of MCL and SM. Because SM is considered as optimization of a measurement model in terms of the probabilistic modeling, we perform measurement model optimization as SM. The optimization result is then used to approximate the measurement model distribution and the approximated distribution is used to sample particles. The sampled particles are fused with MCL via importance sampling. As a result, the advantages of MCL and SM can be simultaneously utilized while mitigating their disadvantages. Experiments are conducted on the KITTI dataset and other two open datasets. Results show that the presented method can be run on a single CPU thread and accurately perform localization even if INS is not available.

机构、总结、中文摘要均由AI分析而来,可能存在错误,请以论文正文为准。

↑