基于连续距离场的激光惯性定位映射系统,实现高精度实时状态估计。
2Fast-2Lamaa: Large-Scale Lidar-Inertial Localization and Mapping with Continuous Distance Fields
- 通过连续IMU预积分建模每点姿态,无先验地校正扫描畸变。
- 在250公里数据上实现0.27%的里程计误差和0.06米的定位误差。
- 支持车载与手持设备,可实时构建并清理动态物体的增量地图。
本文提出2Fast-2Lamaa,一种用于里程计、建图与定位的激光惯性状态估计算法。其核心是基于优化的激光扫描去畸变,利用连续IMU预积分建模每个激光点时刻的系统位姿。100-200毫秒的连续轨迹仅由初始扫描条件(线速度、重力方向)和IMU偏差参数化,共11个状态变量。通过最小化点到线、点到面距离,在无需依赖先前估计的情况下完成无先验运动畸变校正,直接输出帧间里程计。为保持长期几何一致性,去畸变扫描用于帧到地图匹配。地图采用高斯过程表示连续距离场,支持空间任意位置的点到曲面距离查询。通过非线性最小二乘优化,进一步优化去畸变扫描的位姿。里程计与建图采用增量式实时构建;纯定位则复用已有地图。增量建图包含动态物体移除机制。在超过250公里(10小时以上)的公开及自采数据集上进行评估,涵盖车载与手持设备。该框架在多样化挑战场景下表现达到业界领先水平,里程计误差低至0.27%,定位误差达0.06米。实时实现已开源:https://github.com/clegenti/2fast2lamaa。
原文摘要 · Abstract (English)
This paper introduces 2Fast-2Lamaa, a lidar-inertial state estimation framework for odometry, mapping, and localization. Its first key component is the optimization-based undistortion of lidar scans, which uses continuous IMU preintegration to model the system's pose at every lidar point timestamp. The continuous trajectory over 100-200ms is parameterized only by the initial scan conditions (linear velocity and gravity orientation) and IMU biases, yielding eleven state variables. These are estimated by minimizing point-to-line and point-to-plane distances between lidar-extracted features without relying on previous estimates, resulting in a prior-less motion-distortion correction strategy. Because the method performs local state estimation, it directly provides scan-to-scan odometry. To maintain geometric consistency over longer periods, undistorted scans are used for scan-to-map registration. The map representation employs Gaussian Processes to form a continuous distance field, enabling point-to-surface distance queries anywhere in space. Poses of the undistorted scans are refined by minimizing these distances through non-linear least-squares optimization. For odometry and mapping, the map is built incrementally in real time; for pure localization, existing maps are reused. The incremental map construction also includes mechanisms for removing dynamic objects. We benchmark 2Fast-2Lamaa on 250km (over 10h) of public and self-collected datasets from both automotive and handheld systems. The framework achieves state-of-the-art performance across diverse and challenging scenarios, reaching odometry and localization errors as low as 0.27% and 0.06 m, respectively. The real-time implementation is publicly available at https://github.com/clegenti/2fast2lamaa.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。