arXivDaily arXiv每日学术速递 周一至周五更新
arXiv 2402.05540cs.RO
收藏

基于滑动窗口因子图优化的三维先验地图紧耦合测距惯性定位

Tightly Coupled Range Inertial Localization on a 3D Prior Map Based on Sliding Window Factor Graph Optimization

National Institute of Advanced Industrial Science and Technology(独立行政法人产业技术综合研究所)

Kenji Koide, Shuji Oishi, Masashi Yokozuka, Atsuhiko Banno

AI总结:

本文提出一种基于滑动窗口因子图紧耦合扫描间与扫描至地图配准因子及IMU因子的三维先验地图测距惯性定位算法,并设计了鲁棒的初始状态估计方法,在点云退化等极端条件下优于现有方法。

摘要:

本文提出了一种针对三维先验地图的测距惯性定位算法。该算法在滑动窗口因子图上,将扫描间(scan-to-scan)和扫描至地图(scan-to-map)的点云配准因子与IMU因子进行紧耦合。扫描间和扫描至地图配准因子的紧耦合,实现了传感器自身运动估计与基于地图的轨迹校正的平滑融合,从而在点云严重退化及地图存在缺陷区域的情况下,实现对传感器位姿的鲁棒跟踪。我们还提出了一种初始传感器状态估计算法,该算法能够鲁棒地估计重力方向和IMU状态,并有助于在无先验位置信息的系统初始化时,在3或4自由度内执行全局定位。实验结果表明,在点云数据退化、传感器瞬时中断、传感器沿地图边界移动或进入未映射区域等极端严峻情况下,所提方法优于现有最先进的方法。

英文摘要:

This paper presents a range inertial localization algorithm for a 3D prior map. The proposed algorithm tightly couples scan-to-scan and scan-to-map point cloud registration factors along with IMU factors on a sliding window factor graph. The tight coupling of the scan-to-scan and scan-to-map registration factors enables a smooth fusion of sensor ego-motion estimation and map-based trajectory correction that results in robust tracking of the sensor pose under severe point cloud degeneration and defective regions in a map. We also propose an initial sensor state estimation algorithm that robustly estimates the gravity direction and IMU state and helps perform global localization in 3- or 4-DoF for system initialization without prior position information. Experimental results show that the proposed method outperforms existing state-of-the-art methods in extremely severe situations where the point cloud data becomes degenerate, there are momentary sensor interruptions, or the sensor moves along the map boundary or into unmapped regions.

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

↑