Predicting the Performance of Cooperative Simultaneous Localization and Mapping (C-SLAM)

In this paper we study the time evolution of the position estimates’ covariance in Cooperative Simultaneous Localization and Mapping (C-SLAM), and obtain analytical upper bounds for the positioning uncertainty. The derived bounds provide descriptions of the asymptotic positioning performance of a team of robots in a mapping task, as a function of the characteristics of the proprioceptive and exteroceptive sensors of the robots, and of the graph of relative position measurements recorded by the robots. A study of the properties of the Riccati recursion, which describes the propagation of uncertainty through time, yields (i) the guaranteed accuracy for a robot team in a given C-SLAM application, as well as (ii) the maximum expected steady-state uncertainty of the robots and landmarks, when the spatial distribution of features in the environment can be modeled by a known distribution. The theoretical results are validated both in simulation and experimentally.

[1]  Jeffrey K. Uhlmann,et al.  Simultaneous localisation and map building using split covariance intersection , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[2]  Stergios I. Roumeliotis,et al.  Performance Bounds for Cooperative Simultaneous Localization and Mapping (C-SLAM) , 2005, Robotics: Science and Systems.

[3]  Stergios I. Roumeliotis,et al.  Distributed multirobot localization , 2002, IEEE Trans. Robotics Autom..

[4]  Fan Chung,et al.  Spectral Graph Theory , 1996 .

[5]  Stephen P. Boyd,et al.  Convex Optimization , 2004, Algorithms and Theory of Computation Handbook.

[6]  Randall Smith,et al.  Estimating Uncertain Spatial Relationships in Robotics , 1987, Autonomous Robot Vehicles.

[7]  Stergios I. Roumeliotis,et al.  Collective localization: a distributed Kalman filter approach to localization of groups of mobile robots , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[8]  Stergios I. Roumeliotis,et al.  Performance analysis of multirobot Cooperative localization , 2006, IEEE Transactions on Robotics.

[9]  John J. Leonard,et al.  Explore and return: experimental validation of real-time concurrent mapping and localization , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[10]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[11]  Andrew Howard,et al.  Multi-robot mapping using manifold representations , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[12]  Peter K. Allen,et al.  Localization methods for a mobile robot in urban environments , 2004, IEEE Transactions on Robotics.

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

[14]  Ryo Kurazume,et al.  Cooperative positioning with multiple robots , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[15]  Juan Andrade-Cetto,et al.  The effects of partial observability in SLAM , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[16]  Lynne E. Parker,et al.  Distributed Cooperative Outdoor Multirobot Localization and Mapping , 2004 .

[17]  Gregory Dudek,et al.  Multi-Robot Exploration of an Unknown Environment, Efficiently Reducing the Odometry Error , 1997, IJCAI.

[18]  Stefan B. Williams,et al.  An efficient approach to the simultaneous localisation and mapping problem , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[19]  Gaurav S. Sukhatme,et al.  Experiments with a Large Heterogeneous Mobile Robot Team: Exploration, Mapping, Deployment and Detection , 2006, Int. J. Robotics Res..

[20]  Raja Chatila,et al.  Stochastic multisensory data fusion for mobile robot location and environment modeling , 1989 .

[21]  J. W. Fenwick,et al.  Collaborative concurrent mapping and localization , 2001 .

[22]  Lynne E. Parker,et al.  Distributed heterogeneous outdoor multi-robot localization , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[23]  Babak Hassibi.  Indefinite metric spaces in estimation, control and adaptive filtering , 1996 .

[24]  Richard Volpe.  Mars rover navigation results using sun sensor heading determination , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[25]  Andrea Garulli,et al.  Simultaneous localization and map building for a team of cooperating robots: a set membership approach , 2003, IEEE Trans. Robotics Autom..

[26]  John J. Leonard,et al.  Cooperative concurrent mapping and localization , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[27]  Gregory Dudek,et al.  Multi-robot cooperative localization: a study of trade-offs between efficiency and accuracy , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Gaurav S. Sukhatme,et al.  Putting the 'I' in 'team': an ego-centric approach to cooperative localization , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[29]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[30]  Sebastian Thrun,et al.  A Probabilistic On-Line Mapping Algorithm for Teams of Mobile Robots , 2001, Int. J. Robotics Res..

[31]  Alonzo Kelly.  General solution for linearized systematic error propagation in vehicle odometry , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[32]  Hugh F. Durrant-Whyte,et al.  Closed form solutions to the multiple-platform simultaneous localization and map building (SLAM) problem , 2000, SPIE Defense + Commercial Sensing.

[33]  Brett Kennedy,et al.  Design and analysis of a sun sensor for planetary rover absolute heading detection , 2001, IEEE Trans. Robotics Autom..

[34]  Belur V. Dasarathy,et al.  Sensor Fusion: Architectures, Algorithms, and Applications , 1998 .

[35]  Stergios I. Roumeliotis,et al.  Analysis of positioning uncertainty in reconfigurable networks of heterogeneous mobile robots , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[36]  Stergios I. Roumeliotis,et al.  Optimal sensor scheduling for resource-constrained localization of mobile robot formations , 2006, IEEE Transactions on Robotics.

[37]  Ingemar J. Cox,et al.  Autonomous Robot Vehicles , 1990, Springer New York.