基于边图重构权重模型的位姿图优化算法
Edge Graph Reconstructed Weight Model for Pose Graph Optimization Algorithm
-
摘要: 基于图优化的同时定位与建图(Simultaneous Localization and Mapping,SLAM)系统中,错误闭环边的存在会干扰图优化器的收敛,导致优化速度下降,从而降低了SLAM系统的精度和鲁棒性。因此,针对错误闭环边,提出了基于边图重构权重模型的位姿图优化(Edge Graph Reconstructed weight model for Pose Graph Optimization,EGR-PGO)算法,有效提高位姿图优化算法的鲁棒性。该算法引入边图转换模型,利用PageRank算法,对权重函数的参数进行动态调整,从而实现对闭环边权重的优化。在每次迭代过程中,该算法都会依据残差的变化量和闭环边的长度再次剔除错误闭环边,以降低错误闭环边对优化过程产生的干扰。最后,在PGO数据集上进行蒙特卡洛实验。实验结果验证了EGR-PGO算法的快速性和鲁棒性及剔除错误闭环边时的有效性。Abstract: In simultaneous localization and mapping (SLAM) systems based on graph optimization, the presence of erroneous closed-loop edges can interfere with the convergence of the graph optimizer, leading to a decrease in optimization speed and thus reducing the accuracy and robustness of the SLAM system. Therefore, we propose a pose graph optimization algorithm based on edge graph reconstructed weight model for erroneous closed-loop edges (EGR-PGO), which effectively improves the robustness of PGO algorithm. The algorithm introduces an edge graph transformation model and uses PageRank algorithm to dynamically adjust the parameters of the weight function, thereby optimizing the weights of closed-loop edges. In each iteration process, the algorithm will remove the erroneous closed-loop edges again based on the change in residuals and the length of the closed-loop edges to reduce the interference of erroneous closed-loop edges on the optimization process. Finally, we conduct Monte Carlo experiments on the PGO dataset, and the experimental results verify the speed and robustness of the EGR-PGO algorithm, as well as its effectiveness in the presence of error-loop-closure edges.
下载: