18 August 2021 in IEEE Robotics and Automation Letters
Multiview registration is used to estimate Rigid Body Transformations (RBTs) from multiple frames and reconstruct a scene with corresponding scans. Despite the success of pairwise registration and pose synchronization, the concept of Bundle Adjustment (BA) has been proven to better maintain global consistency. So in this work, we make the multiview point-cloud registration more tractable from a different perspective in resolving range-based BA. We first analyse the optimal condition of the objective function of BA that unifies some previous approaches. Based on this analysis, we propose an objective function that takes both measurement noises and computational cost into account. For the feature parameter update, instead of calculating the global distribution parameters from the raw measurements, we aggregate the local distributions in a frame-wise fashion at each iteration. The computational cost of feature update is then only dependent on the number of scans. Finally, we develop a multiview registration system using voxel-based quantization that can be applied in real-world scenarios. The experimental results demonstrate our superiority over the baselines in terms of both accuracy and speed. Moreover, the results also show that our average positioning errors achieve the centimeter level. Related materials are available at our project page https://hyhuang1995.github.io/bareg/.
26 March 2024 in IEEE/ASME Transactions on Mechatronics
Accurately generating ground truth (GT) trajectories is essential for simultaneous localization and mapping (SLAM) evaluation, particularly under varying environmental conditions. This study presents PALoc, a systematic approach that leverages a prior map-assisted framework for the first-time generation of dense six-degree-of-freedom GT poses, significantly enhancing the fidelity of SLAM benchmarks across both indoor and outdoor environments. Our method excels in handling degenerate and stationary conditions frequently encountered in SLAM datasets, thereby increasing robustness and precision. A critical feature of PALoc is the detailed derivation of covariance within the factor graph, enabling an in-depth analysis of pose uncertainty propagation. This analysis plays a pivotal role in illustrating specific pose uncertainty and in elevating trajectory reliability from both theoretical and practical perspectives. In addition, we provide an open-source toolbox for the criteria of map evaluation, facilitating the indirect assessment of overall trajectory precision. Experimental results show at least a 30% improvement in map accuracy and a 20% increase in direct trajectory accuracy compared to the iterative closest point algorithm across diverse environments, with substantially enhanced robustness Our publicly available solution, PALoc, extensively applied in the FusionPortable dataset, is geared toward SLAM benchmark augmentation and represents a significant advancement in SLAM evaluation.