arXiv:2607.09947cs.RO2026-07

修复iG-LIO在ROS 2中因工具链导致的数值发散问题,提升稳定性。

A Numerically-Robust ROS 2 Port of iG-LIO: Diagnosing and Fixing Toolchain-Induced Failures in Incremental GICP LiDAR-Inertial Odometry

论文配图:A Numerically-Robust ROS 2 Port of iG-LIO: Diagnosing and Fixing Toolchain-Induced Failures in Incremental GICP LiDAR-Inertial Odometry
图 1 · 摘自论文原文
  • 发现并修复了ROS 2工具链引起的IMU数据丢失与累加器未初始化问题。
  • 在三类设备上验证稳定运行:Ouster OS0/OS1 Rev7 和 Livox MID-360。
  • 支持新Ouster、Velodyne M1600和Livox多种数据格式,可配置运行。

iG-LIO 是一种紧耦合的激光雷达惯性里程计系统,通过迭代误差状态卡尔曼滤波器在增量体素地图上融合广义ICP与点面约束。本文开源了基于ROS 2 Jazzy的原ROS 1实现版本,并诊断出移植后出现的环境相关数值错误:尽管算法数学不变、编译运行正常,却出现NaN值发散。根本原因在于现代ROS 2工具链——服务质量(QoS)不匹配导致IMU样本被静默丢弃与重排,以及oneTBB + Eigen组合引发的并行归约累加器未初始化。同时修正了新版Ouster点云解析问题,确保正确去畸变;新增支持Velodyne Velarray M1600;提供编译时选择的Livox CustomMsg路径与无需驱动的标准PointCloud2路径;并通过YAML暴露运行时配置。已在Ouster OS0 Rev7、OS1 Rev7及Livox MID-360上完成验证。本报告为该移植版本的可引用参考,不涉及底层算法声明 [1]。ROS 2版iG-LIO代码见 https://github.com/Forestry-Robotics-UC/ig_lio/tree/ros2-jazzy。

原文摘要 · Abstract (English)

iG-LIO is a tightly-coupled LiDAR-inertial odometry system fusing generalized-ICP and point-to-plane constraints in an iterated error-state Kalman filter over an incremental voxel map. We report an open-source ROS 2 Jazzy port of the original ROS 1 implementation and, more importantly, the diagnosis of environment-induced numerical failures that appear only after the port: a mechanically faithful migration -- estimation mathematics left unchanged -- compiled and ran, yet diverged with NaN internal values. Both causes trace to the modern ROS 2 toolchain, not the algorithm: a Quality-of-Service (QoS) mismatch that silently drops and reorders IMU samples, and an uninitialized parallel-reduce accumulator arising from the oneTBB + Eigen combination shipped with current distributions. We further correct Ouster point-field parsing to ensure correct point cloud undistortion with newer Ouster revisions, add Velodyne Velarray M1600 support, provide both a compile-time-gated Livox CustomMsg path and a driver-free path for Livox sensors publishing standard PointCloud2 (e.g. Mid-360), and expose the runtime via YAML. The result has been validated in an Ouster OS0 Rev7, an Ouster OS1 Rev 7, and a Livox MID-360. This report is a citable reference for the port itself, not a claim on the underlying algorithm [1]. The ROS 2 port of iG-LIO described in this document can be found at https://github.com/Forestry-Robotics-UC/ig_lio/tree/ros2-jazzy.

激光雷达里程计ROS2数值稳定

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