1 Introduction
Mapping is one of the most fundamental and difficult issues in robotics, and has attracted more and more attention since the seminal work presented in Smith87 . In the past few decades, many effective approaches Thrun05 have been proposed to build several kinds of environment maps, such as grid map Giorg07 , feature map John11 , topological map Lui12 , and hybrid map Bibby10 , etc. As a kind of probabilistic map, the occupancy grid map is not required to extract any special features from environments, so it can easily model arbitrary types of environments. Therefore, the grid map is one of the most popular map representations in robot mapping. However, most of robot mapping approaches can only build single map for medium scale environments. For the large scale environment, multirobots should cooperatively explore various parts of the same environment so as to build grid map with good efficiency and accuracy. The key problem is how to integrate these local grid maps built by multiple robots into a single global map.
To merge a pair of grid maps, Carpin viewed it as the optimization problem Carpin05 , where the optimal transformation should be searched to align two grid maps to be merged. Subsequently, two stochastic search approaches were proposed to solve this optimization problem Carpin05 ; Carpin06 . Similarly, Li
proposed an grid map merging approach based on the genetic algorithm
Li14 . Although these approaches may obtain the optimal rigid transformation, they are all timeconsuming due to the nature of exhaustive search. Different from these passive merging approaches, some researchers proposed when two robots meet randomly or search each other out during the mapping, they can perform the map merging by determining their relative pose Howard06 ; Fox06 . What’s more, Carpin then proposed map merging approach based on the Hough transform Carpin08, which can merge grid maps containing the line features. Although this approach can efficiently merge grid map without any line feature extraction, its accuracy should be further improved due to the nature of discretization error in the Hough transform. Besides, it is required that the potentially being merged grid maps should contain a significant overlapping percentage. To address the accuracy issue, Zhu
Zhu13 viewed the grid map merging as the point set registration problem and accomplished it by the trimmed iterative closest point (TrICP) Chet05 ; Phils07 , where the initial parameters are provided by the map merging approach based on the Hough transform. Meanwhile, Blanco proposed a multihypothesis method to provide the initial parameters for point set registration algorithm so as to merge grid maps Blanco13 . By the confirmation of merging hypotheses, it can obtain the robust merging result. To address the robustness issue, Saeedi proposed the improved grid map merging approach based on the Hough transform, which can merge grid map pair even with low overlapping percentage Saee14 . To merge grid maps with different resolutions, Ma put forward an image registration based approach Ma16 , which can determine whether one of the two maps should be minified or magnified in order to be merged with the other. It seems that many proposed approaches can merge grid map pair with good accuracy and efficiency, but few merging approaches can really accomplish simultaneous merging multiple grid maps.Suppose there is a set of unordered grid maps, which are built by multiple robots exploring different parts of the same large environment. These grid maps are nonoverlapping or partially overlapping with each other. Given the reference map, the goal of multiple grid map merging is to integrate these local grid maps into a global map by calculating the global motion for each grid map to the reference map. To solve this problem, many authors declaimed that their pairwise merging approaches can be directly extended to merge multiple grid maps sequentially. More specifically, the pairwise merging algorithm can repeatedly merge two grid maps and integrate them into one grid until all the grid maps are integrated together. However, this kind of approach suffers from the error accumulative problem. As mentioned in Zhu13 ; Ma16 , the problem of pairwise grid map merging can be viewed as the pairwise registration problem Besl92 ; Zhu114 . Accordingly, the problem of multiple grid map merging can also be viewed as multiview registration problem Huber03 ; Ajmal06 ; Zhu16 ; Evang14 ; Govindu14 ; Zhu14 ; Fed16 . However, most of multiview registration should be provided with the good initial motions in advance Evang14 ; Govindu14 ; Zhu14 ; Fed16 . Otherwise, they are unable to accomplish the multiview registration. Besides, although some existing approaches can achieve multiview registration without initial motions, they are designed to deal with 3D range scan and always timeconsuming Huber03 ; Ajmal06 ; Zhu16 . Therefore, it is required to design an automatic multiview registration approach, which can efficiently deal with 2D grid maps. Recently, motion averaging algorithm has been introduced as an effective means to solve the multiview registration problem Govindu04 . Although this approach can effectively accomplish the multiview registration, it should be provided with good initial global motions and reliable pairwise registration results Govindu14 ; Govindu06 .
Based on the original motion averaging algorithm, this paper proposes an effective grid map merging approach, which can simultaneously merge multiple grid maps without any prior information. As it is difficult to directly calculate the global motions for these grid maps, the proposed approach accomplish the merging of multiple grid maps by three steps. Firstly, the pairwise merging method is presented to estimate relative motions for the grid map pair, which has a certain amount of overlapping percentage. As the pairwise merging algorithm may be applied to some grid map pairs, which have low overlapping percentages or even nonoverlapping, the estimated relative motion may be unreliable. Therefore, all grid maps and the estimated relative motions are utilized to construct a undirected graph so as to sample the maximal connected subgraph (MCS). By confirming the sampled MCS with all relative motions, it is easy to calculate the initial global motions and eliminate all unreliable relative motions. Subsequently, the motion averaging algorithm can be adopted to refine the initial global motions so as to obtain accurate global motions for merging multiple grid maps. To illustrate its superiority, the proposed approach is tested on some real robot data sets.
This paper is organized as follows. In the next section, the grid map merging problem is stated and the TrICP algorithm is briefly reviewed. Section 3 proposes our approach for simultaneous merging of multiple grid maps. In Section 4, the proposed approach is tested and evaluated on three real robot data sets. Finally,some conclusions are drawn in Section 5.
2 Problem Statement and the TrICP algorithm
This section firstly states the problem of grid map merging. As pairwise map merging is the basis of multiple map merging, it then briefly reviews the 2D TrICP algorithm for the pairwise map merging.
2.1 Problem Statement
To build large grid map, mapping can be cooperatively implemented by multiple robots exploring different parts of the environment. Accordingly, a set of local grid maps built by different robots should be integrated into one global grid map.
Suppose there are two local grid maps built by robots exploring two parts of the same environment. According to Carpin08 , the goal of pairwise map merging is to find a relative motion:
(1) 
with which these two local maps can be properly integrated into a global map. More specifically, denotes a rotation matrix determined by the angle and
is a translation vector:
(2) 
Given a set of local grid maps, the goal of multiple grid map merging is to integrate these local maps into a single global map. Without loss of generality, the first grid map can be viewed as the reference map. As shown in Fig 1, this merging problem is equivalent to calculating a set of global motions , so that these local maps can be properly merged into a global global map.
2.2 The TrICP algorithm
Suppose there are two grid maps with nonoverlapping areas, the model map and the subject map , where represents their overlapping percentage. By applying the edge extraction algorithm, two edge point sets and can be extracted from these two grid maps to be merged. Denote as the point subset, which corresponds the overlapping part of the subject map to the model map. For pairwise map merging, the relative motion can be estimated by minimizing the following objective function:
(3) 
where
denotes the 2D identity matrix,
is a preset parameter and indicate the cardinality of a set.Actually, Eq. (3) can be solved by the TrICP algorithm Chet05 ; Phils07 , which can obtain the optimal relative motion by iterations. Given the initial relative motion , three steps are included in each iteration of this algorithm:
(1) Based on the previous motion, establish the point correspondence for each edge point in the subject map:
(4) 
(2) Update the th overlapping percentage and its corresponding subset:
(5) 
(3) Calculate the current relative motion:
(6) 
Finally, the optimal relative motion can be obtained by repeating these three steps until some stop conditions are satisfied. It should be noted that the TrICP algorithm can only obtain reliable relative motions for the grid map pair, which contains a certain amount of overlapping percentage Zhu114 .
3 Merging multiple grid maps
This section proposes the effective approach for simultaneous merging of multiple grid maps by the robust motion averaging.
Given a set of gird maps, the proposed approach can accomplish grid map merging by three steps displayed in Fig. 2. Firstly, the pairwise merging method is presented to estimate the relative motions for many grid map pairs. Subsequently, all grid maps and the estimated relative motions can be viewed as an undirected graph, where each vertex denotes a grid map and each edge indicates an estimated relative motion between the two vertices. Then, a randomized sampling scheme is utilized to find the maximal connected subgraph (MCS). As there may exist unreliable relative motions obtained from the pairwise merging step, the sampling MCS should be confirmed by all relative motions. The process of MCS sampling and confirming should be repeated until the preset number of iterations so as to search for the optimal MCS and eliminate unreliable relative motions. Finally, the accurate global motions can be recovered by the application of the 2D motion averaging algorithm to all reliable relative motions.
3.1 Pairwise grid map merging
To estimate the relative motion , the pairwise grid map merging method should be well designed. As mentioned before, the TrICP algorithm can be utilized to estimate the relative motion of one map pair which includes a certain amount of overlapping percentage. However, owing to the local convergence property, good initial relative motion should be provided to the TrICP algorithm. Otherwise, it is easy to be trapped into the local minimum and obtain the unreliable relative motion.
For the pairwise map merging, the scaleinvariant feature transform (SIFT) futures Lowe04 ; Brown07 can be extracted from two grid maps respectively. As the SIFT features are invariant to rotation and translation changes, it is easy to establish feature matches between these two grid maps. Due to the sensor noise and the accuracy of mapping algorithm, there might exist some false matches. As shown in Fig. 3, there are two grid maps and , which include overlapping areas. Suppose there are a set of SIFT feature matches , which are extracted and matched from these two grid maps. Obviously, if the match is true, the SIFT features and must correspond to the same location of the environment, and they should satisfy the following equation:
(7) 
where denotes the relative motion of these two grid maps, and represent the locations of SIFT features and , respectively. However, the false feature match does not meet this requirement.
According to Eq. (6), two true feature matches are enough to estimate the initial relative motion for the TrICP algorithm. Therefore, the random sample consensus (RANSAC) algorithm can be used to find the true matches. More specifically, two feature matches can be randomly selected from all feature matches so as to calculate the guess of relative motion , then Eq. (7) can be used to test all established feature matches and count the number of true feature matches. And the best guess corresponds to the one, which can receive the support of all true matches. To obtain the best guess, the random guess should be repeatedly generated and tested until the preset maximum number of iteration reaches. Finally, the best guess can be viewed as the initial relative motion of the TrICP algorithm so as to refine the relative motion of two grid maps to be merged.
Based on the above description, the proposed pairwise map merging method can be summarized as the Algorithm 1.
Theoretically, two true feature matches are enough to estimate the initial relative motion for the TrICP algorithm. However, if the number of true matches is less than three, there is no way to confirm and calculate the correct initial motion. To guarantee the robustness, the TrICP algorithm is only applied to these map pairs, which satisfy . Otherwise, there is no need to apply the TrICP algorithm. Suppose SIFT features has been extracted for grid maps and . To establish the feature matches, we can either search the nearest neighbor from the map for each SIFT feature in the map or vice verse. In practice, these two strategies can obtain different number of consistent matches for these two grid maps to be merged. Therefore, during the establishment of feature matches, both strategies should be implemented so as to obtain as many consistent matches as possible.
After the application of pairwise map merging, a set of relative motions can be obtained for the construction of undirected graph so as to sample and confirm the optimal MCS.
3.2 MCS sampling and confirming
Among these estimated relative motions, there may exist some unreliable relative motions due to the unreasonable application of the pairwise merging method to these grid map pairs, which contain low percentage or even nonoverlapping. Therefore, the optimal MCS should be confirmed so as to calculate initial global motions and eliminate unreliable relative motions for the motion averaging.
Given a set of relative motions , it is easy to construct an undirected graph , where one vertex denotes a grid map and each edge indicates the estimated relative motion of its connected grid maps. Accordingly, global motions can be estimated from the MCS, which is composed of edges and vertexes of the graph . As displayed in Fig. 4, based on the MCS, the global motion guess of the th grid map can be directly set as , where has been estimated by the pairwise map merging. Subsequently, the global motion of the th grid map can be calculated as:
(8) 
where has been estimated and included in the relative motion set . As the MCS exits a path between the 1st vertex to all other vertexes in the , Eq. (8) can be transitively used to calculate all other global motions. The main questions arising here are how to sample the MCS from the graph and how to confirm the optimal MCS.
To sample a MCS, we can set a null matrix of the size . As one MCS contains edges of the graph , a subgraph with all vertex of can be generated by the random selection of relative motions from the motion set . Then we can set , if the corresponding relative motion is included in the subgraph . Subsequently, a matrix can be calculated as follows:
(9) 
where denotes the identity matrix of the size . If and only if all the elements of the matrix are nonzeros, the subgraph can be viewed as a MCS of the graph .
As displayed in Fig. 4, only relative motions are contained in the sampled MCS. Hence, all other relative motions can be used to confirm the sampled MCS. Because each edge of the optimal MCS corresponds to a reliable relative motion, Eq.(8) can be transitively used to calculated all global motions with good accuracy. Suppose the graph G includes an reliable relative motion , which is not contained in the optimal MCS. Since the relative motion estimated by the pairwise merging algorithm, it inevitably contains error. Therefore,
(10) 
However, this relationship no longer holds for the unreliable relative motions. In practice, Eq. (10) can be replaced by the following constraint:
(11) 
where denotes the preset distance threshold. Based on this constraint, all estimated relative motions can be used to confirm the optimal MCS, which can receive the support of most relative motions in the graph.
The randomly sampled MCS is not necessary optimal due to the existence of unreliable relative motions, so the sampling and confirming of MCS should be repeatedly until the preset maximum number of iterations are reached. Accordingly, the proposed MCS sampling and confirming method can be summarized as the Algorithm 2.
After the application of MCS sampling and confirming, the initial global motions and a set of reliable relative motions can be obtained for the motion averaging.
3.3 Motion Averaging
Although global motions have been estimated from the optimal MCS by transitively using Eq. (8), they are coarse due to the accumulative error. Since a set of reliable relative motions have been confirmed by the optimal MCS, they can be incorporated to optimize the coarse global motions. The key question arising here is how to use these 2D relative motions so as to refine the coarse global motions. In Govindu04 , Govindu . proposed the 3D motion averaging algorithm, which can refine the coarse global motions by a set of relative motions. For the 2D motion, the original motion averaging algorithm should be extended.
In fact, the 2D motion belongs to the Lie group and its logarithm belongs to the Lie algebra , which can be denoted as follows:
(12) 
where is a vector and
is a skewsymmetric matrix:
(13) 
Accordingly, the Lie algebra can be transformed into other form , where indicates the function which can arrange all parameters of into a compated 3D column vector. Vice verse, can be utilized to denote the inverse function of . By applying the firstorder approximation to the Riemannian distance Govindu04 , there exists the following relationship for two approximate motions and :
(14) 
where the more these two motions are approximate, the more approximates to the term .
Suppose denotes the global motion of the th (th) grid map to the reference map, indicates the relative motion between the th grid map and the th grid map. They obey the constraint . For the problem of multiple map merging, the motions and are variables required to be estimated. While, can be approximated by the one estimated from the pairwise map merging. In other words, and is very approximate. Therefore:
(15) 
As the column vector represents another form of m, the same relationship also holds for the column vector, i.e. . Obviously, all the column vectors can be concatenated into one large vector . Subsequently, the equation can be transformed into the following form:
(16) 
where is the 3D identity matrix, can be viewed as an indicator matrices of size with matrices and at position and , respectively. As there are a set of reliable relative motions confirmed by the optimal MCS, it is convenient to concatenate all increment vectors of relative motions into one large vector , Similarly, all the indicator matrices can also be concatenated into one large matrix . According to Eq. (16), there exists the following relationships:
(17) 
and
(18) 
where denotes the pseudo inverse matrix of . Given the initial global motion , the increment vectors can be incorporated to refine the global motion as follows:
(19) 
where the function denotes the exponential operation of matrix. As displayed in Eq. (14), the motion averaging algorithm cannot obtain the closedform solution for global motions, so it is required to repeat the refinement until some stop conditions are satisfied. The sketch of the global motion refining algorithm is shown in Algorithm 3.
After the application of motion averaging, accurate global motions can be obtained for the merging of multiple grid maps.
3.4 Implementation
Given a set of unordered grid maps, the relative motions of grid maps can be estimated by the pairwise map merging. As there may be exist unreliable relative motions, an undirectedgraph can be constructed by all grid maps and their estimated relative motions. Accordingly, the MCS can be randomly sampled and then confirmed by all estimated relative motions. By repeating the process of MCS sampling, the optimal MCS can be confirmed to calculate the initial global motions and select all reliable relative motions. Consequently, the initial global motions can be refined by applying the motion averaging algorithm to all reliable relative motions. Based on the refined global motions, the set of grid maps can be integrated into a single global map. Therefore, the proposed approach can be outlined in Algorithm 4.
4 Experimental Results
To verify the performance of the proposed approach, a set of experiments were tested on three public datasets: Tim.log Bailey , Intel.log Stachniss15 and Fr079.log Stachniss15 , which were recorded by mobile robots equipped with a laser range finder and odometer. All these datasets were recorded in door environment. To simulate multirobot systems, these three data sets can be separated into four, eight and eleven parts, respectively. By applying the simultaneous localization and mapping(SLAM) algorithm Giorg07 ; Parr05 , they can be used to build grid map sets for testing the proposed approach. These grid map sets are displayed in Figs. 5, 6 and 7 Experiments were implemented in MATLAB on a fourcore 3.6GHz computer with 8GB of memory.
4.1 Validation
To validate the proposed approach, it was firstly tested on the grid map set built from Fr079.log. As shown in Fig. 7, there are eleven unordered grid maps, which require to be merged.
At the beginning, the pairwise merging method should be utilized to calculate the relative motions of grid map pairs. During pairwise merging, true feature matches can be detected between each grid map pairs. Fig. 8 displays the detected number of true feature matches for all grid map pairs. As shown in Fig. 8, there are a portion of map pairs, which are lack of enough true feature matches due to the low overlapping percentages or even nonoverlapping. For these map pairs, it is difficult to estimate their relative motions. For efficiency, the proposed approach only applies the pairwise merging method to these map pairs, which at least contains four detected true feature matches. Given the true feature matches, initial relative motions can be provided to the TrICP algorithm so as to refine the relative motions for grid map pairs. Fig. 8 indicates these map pairs, which can obtain their estimated relative motions. Due to some reasons, the pairwise merging method may obtain some unreliable relative motions.
Subsequently, the undirected graph should be constructed based on all grid maps and estimated relative motions. On the constructed graph, it is easy to randomly sample the MCS, which contains estimated relative motions. As the number of estimated relative motions are more than , the residual relative motions can be utilized to confirm whether the randomly sampled MCS is the optimal one or not. The process of sampling and confirming MCS should be repeated until the preset iteration number is reached. As a result, the optimal MCS can be searched out with all the reliable relative motions. Fig. 8 displays all reliable relative motions and relative motions involved in the optimal MCS. As shown in 8, there are some of map pairs, whose estimated relative motions are unreliable. These unreliable relative motions may be caused by two reasons: (1) False true feature matches can only provide invalid initial relative motions to the TrICP algorithm. (2) Even given moderate initial relative motions, the TrICP algorithm may be trapped into local minimum due to the property of local convergence. To view them in a more intuitive way, Fig. 9 displays the merging results of one map pair, which is denoted in the gray in 8. As shown in Fig. 9, the relative motion of this map pair is really unexpected, so it should be eliminated by the optimal MCS.
As the optimal MCS contains the minimum set of good relative motions, they can be employed to estimate initial global motions. Fig. 12 shows the multiple map merging results based on the initial global motions. As shown in Fig. 12, the initial global motions are not so satisfactory due to the accumulative errors. Hence, they should further be refined by the motion averaging algorithm. With all reliable relative motions, the motion averaging algorithm can calculate accurate global motions for the merging of multiple grid maps. Fig. 12 illustrates the final merging result of multiple grid maps. As shown in Fig. 11, it is really necessary to apply the motion averaging algorithm, which can result in good merging results.
In one word, the proposed approach can accomplish the simultaneous merging of multiple grid maps with good accuracy.
4.2 Comparison
Sequential merging Blanco13  Our method  

Dataset  Obj.  T(s)  Suc  Obj.  T(s)  Suc 
Tim  1.4242  8.7890  Y  0.5546  5.0969  Y 
Ineel  16.2770  28.1093  Y  0.4509  20.4698  Y 
Fr079  4.7405  27.3639  N  0.2940  19.6659  Y 
To illustrate its superiority, the proposed approach requires to be compared with other related grid map merging approaches. However, to the best of our knowledge, few approaches can really accomplish the simultaneous merging of multiple grid maps. Therefore, the proposed approach is only compared with the sequential merging approach based on the pairwise merging algorithm presented in Blanco13 . Experiments were tested on three grid map sets, which are displayed in Figs. 5, 7 and 6, respectively. As there is no ground truth of global motions, the error criterion presented in Zhu16 can be utilized to quantitatively analyze the accuracy of competed merging approaches. During experiments, the runtime, merging error and merging status were recorded in Table 1. To view the results in a more intuitive way, Fig. 11 shows the merging results of three data sets for two competed approaches. As shown in Tabel 1 and Fig. 11, the proposed approach can obtain more efficient and accurate merging results than that of the sequential merging approach.
To merge multiple grid maps, the sequential merging approach estimate the relative motion of two grid maps and integrate them into one grid map, which will further be merged with another new grid map. The process of estimation and merging is repeated until all the grid maps are integrated into one global grid map. Although this approach is straightforward, it suffers from the wellknown problem that merging errors accumulate at each step. As the grid map grows, the accumulate errors may lead to the failure of map merging. Therefore, the sequential merging approach can not always accomplish the merging of multiple grid maps. Besides, this approach requires to repeatedly extract SIFT features from the new merged grid map, so it is less efficient.
However, the proposed approach only utilizes the pairwise merging approach to estimate relative motions of several map pairs. Among these estimated relative motions, there may exist unreliable ones. Subsequently, it randomly samples a minimum set of relative motions to estimate the initial global motions, which can be further confirmed by all relative motions. By repeating the process of sampling and confirming, it can find the optimal MCS for the estimation of initial global motions and confirm all reliable relative motions. Given the initial global motions, the motion averaging algorithm can be applied to all reliable relative motions so as to calculate the accurate global motions for simultaneous merging of multiple grid maps. Hence, the proposed approach can always accomplish merging multiple grid maps with good efficiency and accuracy.
4.3 Robustness to grid map orders
To verify its robustness, the proposed approach was tested on three data sets with different group of orders, which can be randomly changed. During the experiment, grid maps with different orders were viewed as inputs and four groups of map merging results for each data set were recorded in Table 2. To view the results in a more intuitive way, Fig. 12 displays the merged maps for both Tim.log and Intel.log under one group of grid map order. As shown in Table 2, the running time of the proposed approach is varied due to the size of grid map set. Besides, for each data set, the proposed approach can obtain almost the same merging results for different map orders.
Dataset  ID  Error  T(s)  Suc.  

(Coarse)  (Fine)  (Coarse)  (Fine)  
Tim  Order1  0.5713  0.5546  4.7392  0.3577  Y 
Order2  0.5715  0.5560  4.3052  0.3587  Y  
Order3  0.5713  0.5576  4.5370  0.3575  Y  
Order4  0.5874  0.5497  4.0893  0.3582  Y  
Intel  Order1  0.4877  0.4509  19.1101  1.3597  Y 
Order2  0.4906  0.4470  18.8025  1.3739  Y  
Order3  0.4882  0.4390  19.663  1.3715  Y  
Order4  0.4944  0.4560  18.6518  1.3672  Y  
Fr079  Order1  0.3083  0.2940  18.1678  1.4981  Y 
Order2  0.3110  0.2938  18.4086  1.5012  Y  
Order3  0.3084  0.2933  19.4578  1.5157  Y  
Order4  0.3042  0.2936  17.6649  1.4938  Y 
Before performing multiple gird merging, an exhaustive search strategy is utilized to independently estimate the relative motions of map pairs, and the results can be utilized to construct a undirected graph with all grid maps. On this constructed graph, a set of MCS are randomly sampled and then confirmed by all other relative motions. Subsequently, no matter what the order of grid maps is, the proposed approach can always search for the optimal MCS and obtain all the reliable relative motions. Based on the optimal MCS, it is easy to estimate good initial global motions. As shown in Fig 12, initial global motions are not very satisfactory, so they can further be refined by the motion averaging algorithm with all the reliable relative motions. As shown in Table 2, the motion averaging only costs a small portion of merging time but can seriously reduce the merging error. Accordingly, the proposed approach can always obtain the grid map merging results, which are independent with the order of grid maps to be merged. Therefore, the proposed approach is robust to the order of grid maps to be merged.
5 Conclusion
This paper is, to the best of our knowledge, the first that proposes an effective approach for simultaneous merging grid maps built by multiple robots. Given a set of grid maps to be merged, it can accomplish grid map merging by several steps. It first utilizes the pairwise map merging method to estimate the relative motion of grid map pairs. For the reason of low overlapping percentage, it may get unreliable estimation of relative motions for some grid map pairs. Therefore, the minimum set of reliable relative motions should be sampled and confirmed by other relative motions so as to eliminate unreliable relative motions. Then, the initial global motions can be estimated from the minimum set of reliable relative motions. Since the unreliable relative motions have been discarded, the motion averaging algorithm can be applied to the reserved relative motions so as to get accurate global motions for grid map merging. The proposed approach has been implemented and tested on the real robot data sets. Experimental results illustrate that the proposed approach can accomplish simultaneous merging multiple grid maps merging with good accuracy, efficiency and robustness.
The proposed approach includes some limitations. If one grid map has low overlap percentages with all other grid maps, it is difficult to obtain good pairwise merging results for this grid map. In this case, there is no way to integrate it into the global grid maps. However, we note that most merging approaches proposed so far share this limitations as well. Besides, if these grid maps to be merged are in different resolutions, the proposed approach can not accomplish the merging of multiple grid maps. Our future work will focus on addressing the second limitation.
Acknowledgments
This work is supported by the National Natural Science Foundation of China under Grant nos. 61573273, 61573280 and 61503300.
References
 (1) Smith R, Self M, Cheeseman P, A stochastic map for uncertain spatial relationships, International Symposium on Robotics Research, 467474(1988)
 (2) Thrun S, Probabilistic robotics, 45(3):5257. MIT Press(2005)
 (3) Grisetti G, Stachniss C, Burgard W, Improved Techniques for Grid Mapping With RaoBlackwellized Particle Filters, IEEE Transactions on Robotics, 23(1), 3446(2007)
 (4) Mullane J, Vo BN, Adams MD, Vo BT, A RandomFiniteSet Approach to Bayesian SLAM, IEEE Transactions on Robotics, 27(2), 268282(2011)
 (5) Wen LDL, Jarvis R, A pure visionbased topological SLAM system, International Journal of Robotics Research, 31(4), 403428 (2012)
 (6) Bibby C, Reid I, A hybrid SLAM representation for dynamic marine environments, ICRA, 58(8), 257264(2010)
 (7) Carpin S, Birk A, Jucikas V, On map merging, Robotics and Autonomous Systems, 53(1), 114(2005)
 (8) Birk A, Carpin S, Merging occupancy grid maps from multiple robots, Proceedings of IEEE, 94(7), 13841397(2006)
 (9) Li H, Tsukada M, Nashashibi F, Parent M, Multivehicle Cooperative Local Mapping: A Methodology Based on Occupancy Grid Map Merging, IEEE Transactions on Intelligent Transportation Systems, 15(5), 20892100(2014)
 (10) Howard A, Parker LE, Sukhatme GS, Experiments with a large heterogeneous mobile robot team: exploration, mapping, deployment and detection, International Journal of Robotics Research, 25(5), 431447(2005)
 (11) Fox D, Ko J, Konolige K, et al, Distributed multirobot exploration and mapping, Proceedings of IEEE, 94(7), 13251339(2006)
 (12) Carpin S, Fast and accurate map merging for multirobot systems, Autonomous Robots, 25(3), 305316(2008)
 (13) Zhu J, Du S, Ma L, et al, Merging grid maps via point set registration, International Journal of Robotics and Automation, 28(2), 180191(2013).
 (14) Chetverikov D, Stepanov D, Krsek P, Robust Euclidean alignment of 3D point sets: the trimmed iterative closest point algorithm, Image and Vision Computing, 23(3), 299309(2005)

(15)
Phillips JM, Liu R, Tomasi C, Outlier Robust ICP for Minimizing Fractional RMSD, International Conference on 3d Digital Imaging and Modeling, 606098, 427434(2007)
 (16) Blanco JL, Gonz lezjim nez J, Fern ndezmadrigal JA, A robust, multihypothesis approach to matching occupancy grid maps, Robotica, 31(5), 687701(2013)
 (17) Saeedi S, Paull L, Trentini M, et al, Map merging for multiple robots using Hough peak matching, Robotics and Autonomous Systems, 62(10), 14081424(2014)
 (18) Ma L, Zhu J, Zhu L, et al, Merging grid maps of different resolutions by scaling registration, Robotica, 34(11), 25162531(2016)
 (19) Besl PJ, McKay ND, A method for registration of 3D shapes, IEEE Transactions on Pattern Anallysis and Machine Intelligence, 14(2), 239256(1992)
 (20) Zhu J, Meng D, Li Z, Robust registration of partially overlapping point sets via genetic algorithm with growth operator, IET Image Processing, 8(10), 582590(2014)
 (21) Huber DF, Heber M, Fully automatic registration of multiple 3D data sets, Image and Vision Computing, 21(7), 637650(2003)
 (22) Mian AS, Bennamoun M, Owens R, ThreeDimensional ModelBased Object Recognition and Segmentation in Cluttered Scenes, IEEE Transactions on Pattern Anallysis and Machine Intelligence, 28(10), 15841601(2006)
 (23) Zhu J, Zhu L, Li Z, Automatic multiview registration of unordered range scans without feature extraction, Neurocomputing, 171(C), 14441453(2016)

(24)
Evangelidis GD, KounadesBastian D, Horaud R, Psarakis EZ. A generative model for the joint registration of multiple point sets, Proceedings of European Conference on Computer Vision (ECCV), 8695, 109122(2014)
 (25) Govindu VM, Pooja A, On Averaging Multiview Relations for 3D Scan Registration, IEEE Transactions Image Processing, 23(3), 12891302(2014).
 (26) Zhu J, Surface reconstruction via efficient and accurate registration of multiview range scans, Optical Engineering, 53(10), 102104(2014)
 (27) Arrigoni F, Rossi B, Fusiello A, Global Registration of 3D Point Sets via LRS Decomposition. Proceedings of European Conference on Computer Vision (ECCV), 489501(2016)

(28)
Govindu VM, LieAlgebraic averaging for globally consistent motion estimation, Computer Vision and Pattern Recognition(CVPR), 1, I684I691(2004)
 (29) Govindu VM, Robustness in Motion Averaging, Asian Conference on Computer Vision, 3852, 457466(2006)
 (30) Lowe DG, Distinctive image features from scaleinvariant keypoints, International Journal of Computer Vision, 60(2), 91110(2004)
 (31) Brown, Matthew, Lowe, et al, Automatic panoramic image stitching using invariant features, International Journal of Computer Visionk, 74(1), 5973(2007).
 (32) Stachniss C, Robotics Datasets [Online],available:http://www.ipb.unibonn.de/data/, Jun. 15th, 2017
 (33) Bailey T, Robotics Datasets [Online],available:http://wwwpersonal.acfr.usyd.edu.au/tbailey/software/scan_matching.zip, Jun. 15th, 2017
 (34) Eliazar AI, Parr R, Hierarchical Linear/Constant Time SLAM Using Particle Filters for Dense Maps, NIPS, 339346(2005)
Comments
There are no comments yet.