Abstract
In this paper, we present a duo-graph Simultaneous Localization and Mapping (SLAM) method that enables visual-guided robot to efficiently and robustly generate consistent 3D map in a large-scale environment. Recently the conditional independent graph (CI-GRAPH) has been proved to be an efficient and robust method for solving the large-scale SLAM problem. However, it stems from extended kalman filter (EKF) SLAM that suffers from high computational load when number of the landmarks becomes large. Moreover, the big noise in the measurement can lead EKF SLAM far from convergence. These disadvantages are the cases in the visual-guided robot. To solve these problems, we propose a duo-graph structure that sustains the feasibility of a hierarchical graph-based SLAM framework. It implements two level graph-based SLAM$:$ local and global SLAM. Utilizing the characteristic of the duo-graph structure, the local SLAM can efficiently localize itself while the global SLAM can accurately close loops in the large scale environment. In addition, our method can filter massive noisy visual features and eliminate mismatches in the global SLAM process. To demonstrate the superiority of our method, both simulation and real experiments are carried out.