2024 | Xiangcheng Hu, Linwei Zheng, Jin Wu, Ruoyu Geng, Yang Yu, Hexiong Wei, Xiaoyu Tang, Lujia Wang, Jianhao Jiao, and Ming Liu
PALoc is a novel approach for generating dense 6-DoF ground truth (GT) trajectories to enhance SLAM benchmarking. It leverages a prior map-assisted framework to produce accurate GT poses for both indoor and outdoor environments, significantly improving the fidelity of SLAM benchmarks. The method excels in handling degenerate and stationary conditions, increasing robustness and precision. A key feature is the detailed derivation of covariance within the factor graph, enabling in-depth analysis of pose uncertainty propagation. This analysis helps illustrate specific pose uncertainty and improves trajectory reliability from both theoretical and practical perspectives. An open-source toolbox is provided for map evaluation, facilitating indirect assessment of trajectory precision. Experimental results show at least a 30% improvement in map accuracy and a 20% increase in direct trajectory accuracy compared to the ICP algorithm across diverse environments. PALoc is extensively applied in the FusionPortable dataset and represents a significant advancement in SLAM evaluation. The method uses a factor graph-based approach, integrating specialized modules for degeneracy handling and Zero Velocity Update (ZUPT), refining trajectory accuracy and ensuring robustness against environmental dynamics. The method also integrates a quantitative evaluation module inspired by Multi-View Stereo (MVS) or other reconstruction techniques, offering a nuanced assessment of generated trajectories. This comprehensive approach resolves existing challenges in GT trajectory generation methods and establishes a new benchmark in this domain, demonstrating the practical feasibility and theoretical robustness of the method. The contributions include introducing a prior-assisted localization system for generating dense 6-DoF trajectories, conducting a detailed analysis of uncertainty propagation within the factor graph, and offering an open-source toolbox for map evaluation criteria. The method is applied extensively in the FusionPortable dataset, producing trajectories for 13 of 16 sequences, achieving at least a 30% improvement in map accuracy and a 20% increase in direct trajectory accuracy compared to the ICP algorithm across diverse campus environments. This approach represents the first open-source solution designed specifically for crafting 6-DoF GT trajectories in benchmarking, marking a significant contribution to SLAM research. The method is efficient and scalable, adapting to state-of-the-art LiDAR-centric SLAM systems like LiDAR Odometry, LiDAR-Inertial Odometry (LIO), and LiDAR-Visual-Inertial Odometry (LVIO). The method also includes ZUPT factors for handling static scenes and a degeneracy-aware map factor for robustness in degenerate scenarios. The method provides a detailed analysis of uncertainty propagation within the factor graph, offering theoretical insights and practical implications for trajectory generation tasks. The method is evaluated in various indoor and outdoor environments, demonstrating its accuracy and robustness. The results show that the method achieves high accuracy in trajectory generation and map evaluation, with significant improvements in map accuracy and trajectory precision compared to existing methods. The method is also efficient in terms of computational time, with a reduced per-frame processing duration compared to traditionalPALoc is a novel approach for generating dense 6-DoF ground truth (GT) trajectories to enhance SLAM benchmarking. It leverages a prior map-assisted framework to produce accurate GT poses for both indoor and outdoor environments, significantly improving the fidelity of SLAM benchmarks. The method excels in handling degenerate and stationary conditions, increasing robustness and precision. A key feature is the detailed derivation of covariance within the factor graph, enabling in-depth analysis of pose uncertainty propagation. This analysis helps illustrate specific pose uncertainty and improves trajectory reliability from both theoretical and practical perspectives. An open-source toolbox is provided for map evaluation, facilitating indirect assessment of trajectory precision. Experimental results show at least a 30% improvement in map accuracy and a 20% increase in direct trajectory accuracy compared to the ICP algorithm across diverse environments. PALoc is extensively applied in the FusionPortable dataset and represents a significant advancement in SLAM evaluation. The method uses a factor graph-based approach, integrating specialized modules for degeneracy handling and Zero Velocity Update (ZUPT), refining trajectory accuracy and ensuring robustness against environmental dynamics. The method also integrates a quantitative evaluation module inspired by Multi-View Stereo (MVS) or other reconstruction techniques, offering a nuanced assessment of generated trajectories. This comprehensive approach resolves existing challenges in GT trajectory generation methods and establishes a new benchmark in this domain, demonstrating the practical feasibility and theoretical robustness of the method. The contributions include introducing a prior-assisted localization system for generating dense 6-DoF trajectories, conducting a detailed analysis of uncertainty propagation within the factor graph, and offering an open-source toolbox for map evaluation criteria. The method is applied extensively in the FusionPortable dataset, producing trajectories for 13 of 16 sequences, achieving at least a 30% improvement in map accuracy and a 20% increase in direct trajectory accuracy compared to the ICP algorithm across diverse campus environments. This approach represents the first open-source solution designed specifically for crafting 6-DoF GT trajectories in benchmarking, marking a significant contribution to SLAM research. The method is efficient and scalable, adapting to state-of-the-art LiDAR-centric SLAM systems like LiDAR Odometry, LiDAR-Inertial Odometry (LIO), and LiDAR-Visual-Inertial Odometry (LVIO). The method also includes ZUPT factors for handling static scenes and a degeneracy-aware map factor for robustness in degenerate scenarios. The method provides a detailed analysis of uncertainty propagation within the factor graph, offering theoretical insights and practical implications for trajectory generation tasks. The method is evaluated in various indoor and outdoor environments, demonstrating its accuracy and robustness. The results show that the method achieves high accuracy in trajectory generation and map evaluation, with significant improvements in map accuracy and trajectory precision compared to existing methods. The method is also efficient in terms of computational time, with a reduced per-frame processing duration compared to traditional