Abstract:Aiming at the problem of loop closure detection in monocular simultaneous localization and mapping for mobile robots,a detection algorithm based on visual dictionary (VD) is presented. Firstly, feature extraction is performed for each required image using SURF methods. Subsequently,a fuzzy K-means algorithm is employed to cluster these visual feature vectors into visual words based on VD which is constructed online. To precisely represent the similarities between each visual word and corresponding local visual features ,Gaussian mixture model is proposed to learn the probability model of every visual word in bags of visual words. Consequently,every image can be denoted as a probabilistic vector of VD,and thus the similarities between any two images can be computed based on vector inner product. To guarantee the continuity of the closed-loop detection,a Bayesian filter method is applied to fuse historical closed-loop detection information and the obtained similarities to calculate the posterior probability distribution of closed-loop hypothesis. Furthermore,two memory management mechanisms,shallow memory and deep memory,are introduced to improve the process speed of the proposed algorithm. The experimental results demonstrate the validity of the proposed approach.
[1] Civera J,Davison A,Montiel M. Inverse Depth Parametrization for Monocular SLAM. IEEE Trans on Robotics,2008,24(5): 932-945 [2] Civera J,Davison A,Grasa O G,et al. 1-Point RANSAC for EKF-Based Structure from Motion // Proc of the IEEE International Conference on Intelligent Robots and Systems. St Louis,USA,2009: 3498-3504 [3] Cummins M,Newman P. FAB-MAP: Probabilistic Localization and Mapping in the Space of Appearance. The International Journal of Robotics Research,2008,27(6): 647-665 [4] Folkesson J,Christensen H. Closing the Loop with Graphical SLAM. IEEE Trans on Robotics,2007,23(4): 731-741 [5] Wen L,Ray J. A Pure Vision-Based Topological SLAM System. The International Journal of Robotics Research,2012,31(4): 403-428 [6] Williams B,Cummins M. An Image-to-Map Loop Closing Method for Monocular SLAM // Proc of the IEEE International Conference on Intelligent Robots and Systems. Nice,France,2008: 2053-2059 [7] Cummins M,Newman P. Appearance-Only SLAM at Large Scale with FAB-MAP 2.0. The International Journal of Robotics Research,2011,30(9): 1100-1123 [8] Botterill T,Mill S,Green R. Bags-of-Words-Driven,Single Camera Simultaneous Localization and Mapping. Journal of Field Robotics,2011,28(2): 204-226 [9] Angeli A,Filliat D,Doncieux S,et al. Fast and Incremental Method for Loop-Closure Detection Using Bags of Visual Words.IEEE Trans on Robotics,2008,24(5): 1027-1037 [10] Cummins M,Newman P. Accelerating FAB-MAP with Concentration Inequalities. IEEE Trans on Robotics,2010,26(6): 1042-1050 [11] Labbe M,Michaud F. Memory Management for Real-Time Appearance-Based Loop Closure Detection // Proc of the IEEE International Conference on Intelligent Robots and Systems. San Francisco,USA,2011: 1271-1276 [12] Bay H,Ess A,Tuytelaars T,et al. Speeded Up Robust Features (SURF). Computer Vision and Image Understanding,2008,110(3): 346-359 [13] Jurie F,Triggs B. Creating Efficient Codebooks for Visual Recognition // Proc of the 10th IEEE International Conference on Computer Vision. Beijing,China,2005: 604-610 [14] Nister D,Stewenius H. Scalable Recognition with a Vocabulary Tree // Proc of the IEEE Conference on Computer Vision and Pattern Recognition. New York,USA,2006,Ⅱ: 2161-2168 [15] Moosmann F,Tiggs B,Jurie F. Randomized Clustering Forest for Building Fast and Discriminative Visual Vocabularies // Proc of the Conference on Neural Information Processing System. Vancouver,Canada,2006: 1120-1126 [16] Hu W M,Xie D,Tan T N,et al. Learning Patterns of Activity Using Fuzzy Self-Organizing Neural Network. IEEE Trans on System,Man and Cybernetics,2004,34(3): 1618-1626 [17] Rabiner L R. A Tutorial on Hidden Markov Models and Selected Applications in Speech Recognition. Proc of the IEEE,1989,77(2): 257-286 [18] Xie X,Beni G. A Validity Measure for Fuzzy Clustering. IEEE Trans on Pattern Analysis and Machine Intelligence,1991,13(8): 841-847 [19] Nister D,Naroditsky O,Bergen J. Visual Odometry for Ground Vehicle Applications. Journal of Field Robotics,2006,23(1): 3-20 [20] Giorgio G,Cyrill S,Wolfram B. Non-Linear Constraint Network Optimization for Efficient Map Learning. IEEE Trans on Intelligent Transportation Systems,2009,10(3): 428-439