Cooperative Robot Localization Using Event-triggered Estimation

This paper describes a novel communication-spare cooperative localization algorithm for a team of mobile unmanned robotic vehicles. Exploiting an event-based estimation paradigm, robots only send measurements to neighbors when the expected innovation for state estimation is high. Since agents know the event-triggering condition for measurements to be sent, the lack of a measurement is thus also informative and fused into state estimates. The robots use a Covariance Intersection (CI) mechanism to occasionally synchronize their local estimates of the full network state. In addition, heuristic balancing dynamics on the robots' CI-triggering thresholds ensure that, in large diameter networks, the local error covariances remains below desired bounds across the network. Simulations on both linear and nonlinear dynamics/measurement models show that the event-triggering approach achieves nearly optimal state estimation performance in a wide range of operating conditions, even when using only a fraction of the communication cost required by conventional full data sharing. The robustness of the proposed approach to lossy communications, as well as the relationship between network topology and CI-based synchronization requirements, are also examined.

[1]  Wolfram Burgard,et al.  A Probabilistic Approach to Collaborative Multi-Robot Localization , 2000, Auton. Robots.

[2]  Massimo Franceschetti,et al.  The value of timing information in event-triggered control: The scalar case , 2016, 2016 54th Annual Allerton Conference on Communication, Control, and Computing (Allerton).

[3]  Moe Z. Win,et al.  Cooperative Localization in Wireless Networks , 2009, Proceedings of the IEEE.

[4]  Sebastian Trimpe,et al.  LMI-based synthesis for distributed event-based state estimation , 2015, 2015 American Control Conference (ACC).

[5]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[6]  Uwe D. Hanebeck,et al.  Covariance intersection in nonlinear estimation based on pseudo Gaussian densities , 2011, 14th International Conference on Information Fusion.

[7]  Mark E. Campbell,et al.  Distributed Data Fusion: Neighbors, Rumors, and the Art of Collective Knowledge , 2016, IEEE Control Systems.

[8]  Ling Shi,et al.  Event-Based Sensor Data Scheduling: Trade-Off Between Communication Rate and Estimation Quality , 2013, IEEE Transactions on Automatic Control.

[9]  S.S. Blackman,et al.  Multiple hypothesis tracking for multiple target tracking , 2004, IEEE Aerospace and Electronic Systems Magazine.

[10]  Junping Du,et al.  Event-triggered Kalman consensus filter over sensor networks , 2016 .

[11]  Alexander Bahr,et al.  Low-cost collaborative localization for large-scale multi-robot systems , 2012, 2012 IEEE International Conference on Robotics and Automation.

[12]  Raman K. Mehra,et al.  Covariance intersection algorithm for distributed spacecraft state estimation , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[13]  J. M. M. Montiel,et al.  ORB-SLAM: A Versatile and Accurate Monocular SLAM System , 2015, IEEE Transactions on Robotics.

[14]  Niko Sünderhauf,et al.  Switchable constraints for robust pose graph SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Ryo Kurazume,et al.  Study on cooperative positioning system: optimum moving strategies for CPS-III , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[16]  John J. Leonard,et al.  Communication-constrained multi-AUV cooperative SLAM , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[17]  Lang Tong,et al.  Maximum likelihood combining of stochastic maps , 2011, 2011 49th Annual Allerton Conference on Communication, Control, and Computing (Allerton).

[18]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[19]  David W. Murray,et al.  A Square Root Unscented Kalman Filter for visual monoSLAM , 2008, 2008 IEEE International Conference on Robotics and Automation.

[20]  Stergios I. Roumeliotis,et al.  Distributed Maximum A Posteriori Estimation for Multi-robot Cooperative Localization , 2009 .

[21]  Sebastian Thrun,et al.  Simultaneous localization and mapping with unknown data association using FastSLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[22]  Dan C. Marinescu,et al.  Data incest in cooperative localisation with the Common Past-Invariant Ensemble Kalman filter , 2013, Proceedings of the 16th International Conference on Information Fusion.

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

[24]  G. M. Tallis The Moment Generating Function of the Truncated Multi‐Normal Distribution , 1961 .

[25]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[26]  Keith Yu Kit Leung,et al.  Decentralized Localization of Sparsely-Communicating Robot Networks: A Centralized-Equivalent Approach , 2010, IEEE Transactions on Robotics.

[27]  Giorgio Battistelli,et al.  Energy-efficient distributed state estimation via event-triggered consensus on exponential families , 2016, 2016 American Control Conference (ACC).

[28]  清水 邦夫 Continuous Univariate Distributions Volume 1/N.L.Johnson,S.Kotz,N.Balakrishnan(1994) , 1995 .

[29]  Ling Shi,et al.  An event-triggered approach to state estimation with multiple point- and set-valued measurements , 2014, Autom..

[30]  Wolfram Burgard,et al.  Estimating the Absolute Position of a Mobile Robot Using Position Probability Grids , 1996, AAAI/IAAI, Vol. 2.

[31]  Illah R. Nourbakhsh,et al.  DERVISH - An Office-Navigating Robot , 1995, AI Mag..

[32]  Jeffrey K. Uhlmann,et al.  Using covariance intersection for SLAM , 2007, Robotics Auton. Syst..

[33]  Wolfram Burgard,et al.  Fast and accurate SLAM with Rao-Blackwellized particle filters , 2007, Robotics Auton. Syst..

[34]  Donghua Zhou,et al.  Event-Based Recursive Distributed Filtering Over Wireless Sensor Networks , 2015, IEEE Transactions on Automatic Control.

[35]  George A. Bekey,et al.  AUTONOMOUS ROBOTS, From Biological Inspiration to Implementation and Control, by G.A. Bekey, MIT Press, 2005, xv + 577 pp., index, ISBN 0-262-02578-7, 25 pages of references (Hb. £35.95) , 2005, Robotica.

[36]  Sonia Martínez,et al.  A centralized-equivalent decentralized implementation of Extended Kalman Filters for cooperative localization , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[38]  Hanumant Singh,et al.  Advances in single-beacon one-way-travel-time acoustic navigation for underwater vehicles , 2012, Int. J. Robotics Res..

[39]  Matthew R. Walter,et al.  Consistent cooperative localization , 2009, 2009 IEEE International Conference on Robotics and Automation.

[40]  Sonia Martínez,et al.  Cooperative Localization for Mobile Agents: A Recursive Decentralized Algorithm Based on Kalman-Filter Decoupling , 2015, IEEE Control Systems.

[41]  Sebastian Trimpe,et al.  On the choice of the event trigger in event-based estimation , 2015, 2015 International Conference on Event-based Control, Communication, and Signal Processing (EBCCSP).

[42]  Frank Dellaert,et al.  DDF-SAM 2.0: Consistent distributed smoothing and mapping , 2013, 2013 IEEE International Conference on Robotics and Automation.

[43]  Gabe Sibley,et al.  Scalable Multirobot Localization and Mapping with Relative Maps: Introducing MOARSLAM , 2016, IEEE Control Systems.

[44]  Terence H. McLoughlin,et al.  Scalable Sensing, Estimation, and Control Architecture for Large Spacecraft Formations , 2007 .

[45]  Gamini Dissanayake,et al.  Bearing-only SLAM Using a SPRT Based Gaussian Sum Filter , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[46]  Raffaello D'Andrea,et al.  An Experimental Demonstration of a Distributed and Event-Based State Estimation Algorithm , 2011 .

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

[48]  Alcherio Martinoli,et al.  A reciprocal sampling algorithm for lightweight distributed multi-robot localization , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[49]  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).

[50]  Garret N. Vanderplaats,et al.  Numerical optimization techniques for engineering design , 1999 .

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

[52]  Fred Y. Hadaegh,et al.  Distributed estimation, communication and control for deep space formations , 2007 .

[53]  Fawzi Nashashibi,et al.  Cooperative multi-vehicle localization using split covariance intersection filter , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[54]  Zidong Wang,et al.  A survey of event-based strategies on control and estimation , 2014 .

[55]  Manjunath B. G.,et al.  Moments Calculation for the Double Truncated Multivariate Normal Density , 2009, Journal of Behavioral Data Science.

[56]  W. P. M. H. Heemels,et al.  Case Studies in Event-Driven Control , 2007, HSCC.

[57]  N. L. Johnson,et al.  Continuous Univariate Distributions. , 1995 .

[58]  Wolfram Burgard,et al.  Recursive Decentralized Collaborative Localization for Sparsely Communicating Robots , 2016, Robotics: Science and Systems.

[59]  Stergios I. Roumeliotis,et al.  Decentralized multi-robot cooperative localization using covariance intersection , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[60]  Stergios I. Roumeliotis,et al.  Distributed Multi-Robot Localization , 2000, DARS.

[61]  Nathan Michael,et al.  Incremental Distributed Inference from Arbitrary Poses and Unknown Data Association: Using Collaborating Robots to Establish a Common Reference , 2016, IEEE Control Systems.

[62]  Wolfram Burgard,et al.  Robust Monte Carlo localization for mobile robots , 2001, Artif. Intell..

[63]  John W. Fisher,et al.  Nonparametric belief propagation for self-localization of sensor networks , 2005, IEEE Journal on Selected Areas in Communications.

[64]  Sebastian Trimpe,et al.  Event-Based State Estimation With Variance-Based Triggering , 2012, IEEE Transactions on Automatic Control.

[65]  Reid G. Simmons,et al.  Probabilistic Robot Navigation in Partially Observable Environments , 1995, IJCAI.

[66]  Demoz Gebre-Egziabher,et al.  Cooperative inertial navigation , 2014 .

[67]  Prabir Barooah,et al.  Distributed collaborative localization of multiple vehicles from relative pose measurements , 2009, 2009 47th Annual Allerton Conference on Communication, Control, and Computing (Allerton).

[68]  Mircea Lazar,et al.  On Event Based State Estimation , 2009, HSCC.

[69]  Ryo Kurazume,et al.  Study on cooperative positioning system (basic principle and measurement experiment) , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[70]  Hugh F. Durrant-Whyte,et al.  Mobile robot localization by tracking geometric beacons , 1991, IEEE Trans. Robotics Autom..

[71]  Gregory Dudek,et al.  Multi-robot collaboration for robust exploration , 2004, Annals of Mathematics and Artificial Intelligence.

[72]  Kuo-Chu Chang,et al.  Comparison of optimal distributed estimation and consensus filtering , 2016, 2016 19th International Conference on Information Fusion (FUSION).

[73]  Lei Yan,et al.  Distributed state estimation in sensor networks with event-triggered communication , 2014 .

[74]  Florian Heiss,et al.  Likelihood approximation by numerical integration on sparse grids , 2008 .

[75]  Eric W. Frew,et al.  Factorized covariance intersection for scalable partial state decentralized data fusion , 2016, 2016 19th International Conference on Information Fusion (FUSION).

[76]  Russ Tedrake,et al.  Pushbroom stereo for high-speed navigation in cluttered environments , 2014, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[77]  Stergios I. Roumeliotis,et al.  Cooperative multi-robot localization under communication constraints , 2009, 2009 IEEE International Conference on Robotics and Automation.

[78]  Sebastian Trimpe,et al.  Stability analysis of distributed event-based state estimation , 2014, 53rd IEEE Conference on Decision and Control.

[79]  Yang Cheng,et al.  Sparse Gauss-Hermite Quadrature Filter with Application to Spacecraft Attitude Estimation , 2011 .

[80]  Ryan M. Eustice,et al.  Decentralized Extended Information Filter for Single-Beacon Cooperative Acoustic Navigation: Theory and Experiments , 2013, IEEE Transactions on Robotics.

[81]  Sonia Martínez,et al.  Event-based cooperative localization using implicit and explicit measurements , 2015, 2015 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[82]  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).

[83]  Leslie Pack Kaelbling,et al.  Acting under uncertainty: discrete Bayesian models for mobile-robot navigation , 1996, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems. IROS '96.

[84]  Romuald Aufrère,et al.  Localization of a Group of Communicating Vehicles by State Exchange , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[85]  Philip Ferguson,et al.  Decentralized Estimation Algorithms for Formation Flying Spacecraft , 2003 .