In this paper, we propose a novel LiDAR(-inertial) odometry and mapping framework to achieve the goal of simultaneous localization and meshing in real-time. This proposed framework termed ImMesh comprises four tightly-coupled modules: receiver, localization, meshing, and broadcaster. The localization module utilizes the prepossessed sensor data from the receiver, estimates the sensor pose online by registering LiDAR scans to maps, and dynamically grows the map. Then, our meshing module takes the registered LiDAR scan for incrementally reconstructing the triangle mesh on the fly. Finally, the real-time odometry, map, and mesh are published via our broadcaster. The key contribution of this work is the meshing module, which represents a scene by an efficient hierarchical voxels structure, performs fast finding of voxels observed by new scans, and reconstructs triangle facets in each voxel in an incremental manner. This voxel-wise meshing operation is delicately designed for the purpose of efficiency; it first performs a dimension reduction by projecting 3D points to a 2D local plane contained in the voxel, and then executes the meshing operation with pull, commit and push steps for incremental reconstruction of triangle facets. To the best of our knowledge, this is the first work in literature that can reconstruct online the triangle mesh of large-scale scenes, just relying on a standard CPU without GPU acceleration. To share our findings and make contributions to the community, we make our code publicly available on our GitHub: https://github.com/hku-mars/ImMesh.
翻译:摘要:本文提出一种新颖的激光雷达(-惯性)里程计与建图框架,旨在实现实时同步定位与网格构建。该框架名为ImMesh,包含四个紧密耦合的模块:接收器、定位、网格构建与广播器。定位模块利用接收器预处理后的传感器数据,通过将激光雷达扫描与地图配准在线估计传感器位姿,并动态扩展地图。随后,网格构建模块利用配准后的激光雷达扫描增量式实时重建三角网格。最终,实时里程计、地图和网格通过广播器发布。本文的核心贡献在于网格构建模块:该模块采用高效分层体素结构表征场景,快速定位新扫描所观测的体素,并以增量方式在每个体素内重建三角面片。该逐体素网格操作专为高效性设计:首先通过将三维点投影至体素所含的二维局部平面实现降维,随后通过拉取、提交和推送三个步骤执行网格操作,以增量重建三角面片。据我们所知,这是文献中首个仅依赖标准CPU(无需GPU加速)即可在线重建大规模场景三角网格的工作。为分享成果并回馈社区,我们已在GitHub上公开代码:https://github.com/hku-mars/ImMesh。