Maximum Likelihood Fusion of Stochastic Maps

The fusion of independently obtained stochastic maps by collaborating mobile agents is considered. The proposed approach includes two parts: generalized likehood ratio matching and maximum likelihood alignment. In particular, an affine invariant hypergraph model is constructed for each stochastic map and a bipartite matching via a linear program is used to establish landmark correspondence between stochastic maps. A maximum likelihood alignment procedure is proposed to estimate rotation, translation and scale parameters in order to construct a global map of the environment. A main feature of the proposed approach is its scalability with respect to the number of landmarks: the matching step has polynomial complexity and the maximum likelihood alignment solution is obtained in closed form. Experimental validation of the proposed fusion approach is performed using the Victoria Park experimental benchmark.

[1]  N. Nathan.  Self and will , 1997 .

[2]  Jonas Nygårds,et al.  C-SAM: Multi-Robot SLAM using square root information smoothing , 2008, 2008 IEEE International Conference on Robotics and Automation.

[3]  Andrea Garulli,et al.  Multi-robot SLAM using M-Space feature representation , 2010, 49th IEEE Conference on Decision and Control (CDC).

[4]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[5]  Gamini Dissanayake,et al.  Sparse Local Submap Joining Filter for Building Large-Scale Maps , 2008, IEEE Transactions on Robotics.

[6]  Rick S. Blum,et al.  Distributed detection with multiple sensors I. Advanced topics , 1997, Proc. IEEE.

[7]  John J. Leonard,et al.  Robust Mapping and Localization in Indoor Environments Using Sonar Data , 2002, Int. J. Robotics Res..

[8]  Sebastian Thrun,et al.  Multi-robot SLAM with Sparse Extended Information Filers , 2003, ISRR.

[9]  Pramod K. Varshney,et al.  Fusion of decisions transmitted over Rayleigh fading channels in wireless sensor networks , 2006, IEEE Transactions on Signal Processing.

[10]  Venugopal V. Veeravalli,et al.  Decentralized detection in sensor networks , 2003, IEEE Trans. Signal Process..

[11]  Peter Cheeseman,et al.  A stochastic map for uncertain spatial relationships , 1988 .

[12]  Jeffrey K. Uhlmann,et al.  A non-divergent estimation algorithm in the presence of unknown correlations , 1997, Proceedings of the 1997 American Control Conference (Cat. No.97CH36041).

[13]  Shin'ichi Satoh,et al.  The SR-tree: an index structure for high-dimensional nearest neighbor queries , 1997, SIGMOD '97.

[14]  Randall Smith,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[15]  José A. Castellanos,et al.  Robocentric map joining: Improving the consistency of EKF-SLAM , 2007, Robotics Auton. Syst..

[16]  Stefan B. Williams,et al.  Towards multi-vehicle simultaneous localisation and mapping , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[17]  H. Durrant-Whyte,et al.  The ANSER Project: Data Fusion Across Multiple Uninhabited Air Vehicles , 2003 .

[18]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[19]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[20]  Henry Leung,et al.  An exact maximum likelihood registration algorithm for data fusion , 1997, IEEE Trans. Signal Process..

[21]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[22]  E. Groth,et al.  A pattern-matching algorithm for two-dimensional coordinate lists. [for stellar positions] , 1986 .

[23]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[24]  Carlos Sagüés,et al.  Distributed consensus algorithms for merging feature-based maps with limited communication , 2011, Robotics Auton. Syst..

[25]  Hideo Ogawa.  Labeled point pattern matching by Delaunay triangulation and maximal cliques , 1986, Pattern Recognit..

[26]  S. Grime,et al.  Data fusion in decentralized sensor networks , 1994 .

[27]  Pramod K. Varshney,et al.  Distributed detection with multiple sensors I. Fundamentals , 1997, Proc. IEEE.

[28]  Stergios I. Roumeliotis,et al.  Multi-robot SLAM with Unknown Initial Correspondence: The Robot Rendezvous Case , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[29]  Pascal Vasseur,et al.  Introduction to Multisensor Data Fusion , 2005, The Industrial Information Technology Handbook.