Benevides Rubens Antônio Leite, Dos Santos Daniel Rodrigues, Pavan Nadisson Luis, Veiga Luis Augusto Koenig
Polytechnic Center, Federal University of Parana, Curitiba 81530-000, PR, Brazil.
Military Institute of Engineering, Defense Engineering Program, Rio de Janeiro 22290-270, RJ, Brazil.
Sensors (Basel). 2024 Aug 7;24(16):5112. doi: 10.3390/s24165112.
Global pose refinement is a significant challenge within Simultaneous Localization and Mapping (SLAM) frameworks. For LIDAR-based SLAM systems, pose refinement is integral to correcting drift caused by the successive registration of 3D point clouds collected by the sensor. A divergence between the actual and calculated platform paths characterizes this error. In response to this challenge, we propose a linear, parameter-free model that uses a closed circuit for global trajectory corrections. Our model maps rotations to quaternions and uses Spherical Linear Interpolation (SLERP) for transitions between them. The intervals are established by the constraint set by the Least Squares (LS) method on rotation closure and are proportional to the circuit's size. Translations are globally adjusted in a distinct linear phase. Additionally, we suggest a coarse-to-fine pairwise registration method, integrating Fast Global Registration and Generalized ICP with multiscale sampling and filtering. The proposed approach is tested on three varied datasets of point clouds, including Mobile Laser Scanners and Terrestrial Laser Scanners. These diverse datasets affirm the model's effectiveness in 3D pose estimation, with substantial pose differences and efficient pose optimization in larger circuits.
全局位姿优化是同步定位与地图构建(SLAM)框架中的一项重大挑战。对于基于激光雷达的SLAM系统而言,位姿优化对于校正由传感器收集的三维点云连续配准所导致的漂移至关重要。实际平台路径与计算出的平台路径之间的差异表征了这一误差。针对这一挑战,我们提出了一种线性、无参数的模型,该模型使用闭合回路进行全局轨迹校正。我们的模型将旋转映射为四元数,并使用球面线性插值(SLERP)在它们之间进行过渡。这些区间由最小二乘法(LS)对旋转闭合所设定的约束确定,并且与回路的大小成比例。平移则在一个单独的线性阶段进行全局调整。此外,我们还提出了一种从粗到精的成对配准方法,将快速全局配准和广义迭代最近点算法(Generalized ICP)与多尺度采样和滤波相结合。所提出的方法在三个不同的点云数据集上进行了测试,包括移动激光扫描仪和地面激光扫描仪。这些不同的数据集证实了该模型在三维位姿估计中的有效性,在较大的回路中具有显著的位姿差异和高效的位姿优化。