• CN: 11-2187/TH
  • ISSN: 0577-6686

Journal of Mechanical Engineering ›› 2023, Vol. 59 ›› Issue (17): 44-55.doi: 10.3901/JME.2023.17.044

Previous Articles     Next Articles

Multi-robot Collaborative Mapping Based on Enforced Loop Closure and Sequence Matching with Hidden Markov Model

REN Jingyuan1,2, HU Zhaozheng2,3, TAO Qianwen2, LI Na2,3, WAN Jinjie1,2   

  1. 1. School of Information Engineering, Wuhan University of Technology, Wuhan 430070;
    2. Intelligent Transport System Center, Wuhan University of Technology, Wuhan 430063;
    3. Chongqing Research Institute of Wuhan University of Technology, Chongqing 401120
  • Received:2022-09-05 Revised:2022-12-23 Online:2023-09-05 Published:2023-11-16

Abstract: Map construction of large scene can be completed efficiently through multi-robot cooperation. However, the quality of map construction deeply depends on loop closure detection results among multiple robots. Compared to single robot case, the multi-robot loop closure detection problem is more complex and difficult. The proposed method decomposes the multi-robot loop closure detection problem into two independent problems, the problem of loop closure existence and the problem of multi-robot data matching under the condition of the loop closure existence. For the problem of loop closure existence, an enforced loop closure strategy is proposed, which is setting an enforced loop closure area in the scene and enforcing multiple robots to access through. On this basis, the data matching problem across multiple robots is formulated into the hidden Markov model (HMM) based sequence matching problem. By modelling the initial matching results, state transition probability, and emission probability in the HMM model, accurate matching of data sequences collected by different robots can be accomplished. Finally, a multi-robot collaborative mapping method based on large-scale pose graph optimization (PGO) model is proposed, which uses sequence matching results to complete constraint construction and realize multi-robot collaborative mapping. The standard test database and the actual field data collected by multiple robots were used to validate the proposed algorithm. Experimental results show that the proposed multi-robot collaborative mapping method not only effectively improves the mapping efficiency and automation, but also ensures high mapping quality. The results also demonstrate the proposed algorithm outperformances traditional mapping methods.

Key words: large scale scene mapping, multi-robot, hidden Markov model, pose graph optimization

CLC Number: