Distributed Localization and Tracking of Mobile Networks Including Noncooperative Objects

We propose a Bayesian method for distributed sequential localization of mobile networks composed of both cooperative agents and noncooperative objects. Our method provides a consistent combination of cooperative self-localization (CS) and distributed tracking (DT). Multiple mobile agents and objects are localized and tracked using measurements between agents and objects and between agents. For a distributed operation and low complexity, we combine particle-based belief propagation with a consensus or gossip scheme. High localization accuracy is achieved through a probabilistic information transfer between the CS and DT parts of the underlying factor graph. Simulation results demonstrate significant improvements in both agent self-localization and object localization performance compared to separate CS and DT, and very good scaling properties with respect to the numbers of agents and objects.

[1]  Franz Hlawatsch,et al.  Sigma Point Belief Propagation , 2013, IEEE Signal Processing Letters.

[2]  J. Liu,et al.  Multitarget Tracking in Distributed Sensor Networks , 2007, IEEE Signal Processing Magazine.

[3]  R.L. Moses,et al.  Locating the nodes: cooperative localization in wireless sensor networks , 2005, IEEE Signal Processing Magazine.

[4]  Peter I. Corke,et al.  Environmental Wireless Sensor Networks , 2010, Proceedings of the IEEE.

[5]  Ivan Stojmenovic,et al.  Wireless Sensor and Actuator Networks: Algorithms and Protocols for Scalable Coordination and Data Communication , 2010 .

[6]  R. Balakrishnan,et al.  A textbook of graph theory , 1999 .

[7]  Samuel Van de Velde,et al.  Improved Censoring and NLOS Avoidance for Wireless Localization in Dense Networks , 2015, IEEE Journal on Selected Areas in Communications.

[8]  A. Doucet,et al.  Sequential auxiliary particle belief propagation , 2005, 2005 7th International Conference on Information Fusion.

[9]  Henk Wymeersch,et al.  Cooperative simultaneous localization and tracking (coslat) with reduced complexity and communication , 2013, 2013 IEEE International Conference on Acoustics, Speech and Signal Processing.

[10]  Santiago Zazo,et al.  Reducing Communication Overhead for Cooperative Localization Using Nonparametric Belief Propagation , 2012, IEEE Wireless Communications Letters.

[11]  Branko Ristic,et al.  Beyond the Kalman Filter: Particle Filters for Tracking Applications , 2004 .

[12]  Pascal Frossard,et al.  Cooperative Special Issue on Graph Signal Processing in the IEEE Journal of Selected Topics in Signal Processing and the IEEE Transactions on Signal and Information Processing Over Networks , 2017, IEEE Trans. Signal Inf. Process. over Networks.

[13]  Arthur G. O. Mutambara,et al.  Decentralized Estimation and Control for Multisensor Systems , 2019 .

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

[15]  Henk Wymeersch,et al.  Belief consensus algorithms for fast distributed target tracking in wireless sensor networks , 2012, Signal Process..

[16]  X. Jin.  Factor graphs and the Sum-Product Algorithm , 2002 .

[17]  Henk Wymeersch,et al.  Cooperative Synchronization in Wireless Networks , 2013, IEEE Transactions on Signal Processing.

[18]  Paolo Braca,et al.  Scalable multitarget tracking using multiple sensors: A belief propagation approach , 2015, 2015 18th International Conference on Information Fusion (Fusion).

[19]  Soummya Kar,et al.  Gossip Algorithms for Distributed Signal Processing , 2010, Proceedings of the IEEE.

[20]  A. Rahimi,et al.  Simultaneous localization, calibration, and tracking in an ad hoc sensor network , 2006, 2006 5th International Conference on Information Processing in Sensor Networks.

[21]  Yakov Bar-Shalom,et al.  Multitarget-Multisensor Tracking: Principles and Techniques , 1995 .

[22]  Petar M. Djuric,et al.  Consensus-based Distributed Particle Filtering With Distributed Proposal Adaptation , 2014, IEEE Transactions on Signal Processing.

[23]  Neil J. Gordon,et al.  A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking , 2002, IEEE Trans. Signal Process..

[24]  Moe Z. Win,et al.  A Comparison of Parametric and Sample-Based Message Representation in Cooperative Localization , 2012 .

[25]  K. Yıldırım.  CLOCK SYNCHRONIZATION IN WIRELESS SENSOR NETWORKS , 2012 .

[26]  Jorge Cortes,et al.  Distributed Control of Robotic Networks: A Mathematical Approach to Motion Coordination Algorithms , 2009 .

[27]  Mark Hedley,et al.  Fast and Accurate Cooperative Tracking in Wireless Networks , 2013, IEEE Transactions on Mobile Computing.

[28]  Jason L. Williams,et al.  Approximate evaluation of marginal association probabilities with belief propagation , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[29]  Iain B. Collings,et al.  New Efficient Indoor Cooperative Localization Algorithm With Empirical Ranging Error Model , 2015, IEEE Journal on Selected Areas in Communications.

[30]  Nando de Freitas,et al.  The Unscented Particle Filter , 2000, NIPS.

[31]  I JordanMichael,et al.  Graphical Models, Exponential Families, and Variational Inference , 2008 .

[32]  Andreas Springer,et al.  A distributed particle-based belief propagation algorithm for cooperative simultaneous localization and synchronization , 2013, 2013 Asilomar Conference on Signals, Systems and Computers.

[33]  Stephen P. Boyd,et al.  Fast linear iterations for distributed averaging , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

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

[35]  Xiaodong Wang,et al.  Decentralized sigma-point information filters for target tracking in collaborative sensor networks , 2005, IEEE Transactions on Signal Processing.

[36]  Troels Pedersen,et al.  A variational message passing algorithm for sensor self-localization in wireless networks , 2011, 2011 IEEE International Symposium on Information Theory Proceedings.

[37]  Erik G. Larsson,et al.  Target Tracking in Confined Environments With Uncertain Sensor Positions , 2015, IEEE Transactions on Vehicular Technology.

[38]  Ronald P. S. Mahler,et al.  Statistical Multisource-Multitarget Information Fusion , 2007 .

[39]  C. Guestrin,et al.  Distributed localization of networked cameras , 2006, 2006 5th International Conference on Information Processing in Sensor Networks.

[40]  Stergios I. Roumeliotis,et al.  Set-Membership Constrained Particle Filter: Distributed Adaptation for Sensor Networks , 2011, IEEE Transactions on Signal Processing.

[41]  Arnaud Doucet,et al.  Distributed Maximum Likelihood for Simultaneous Self-Localization and Tracking in Sensor Networks , 2012, IEEE Transactions on Signal Processing.

[42]  Henk Wymeersch,et al.  On the separation of timescales in radio-based positioning , 2015, 2015 International Conference on Location and GNSS (ICL-GNSS).

[43]  Murat Üney,et al.  Distributed Fusion of PHD Filters Via Exponential Mixture Densities , 2013, IEEE Journal of Selected Topics in Signal Processing.

[44]  Timothy J. Robinson,et al.  Sequential Monte Carlo Methods in Practice , 2003 .

[45]  Gaurav S. Sukhatme,et al.  Landmark-based Matching Algorithm for Cooperative Mapping by Autonomous Robots , 2000, DARS.

[46]  Petar M. Djuric,et al.  Distributed particle filtering in agent networks: A survey, classification, and comparison , 2013, IEEE Signal Processing Magazine.

[47]  Bernard Mulgrew,et al.  Cooperative sensor localisation in distributed fusion networks by exploiting non-cooperative targets , 2014, 2014 IEEE Workshop on Statistical Signal Processing (SSP).

[48]  Reza Olfati-Saber,et al.  Consensus and Cooperation in Networked Multi-Agent Systems , 2007, Proceedings of the IEEE.

[49]  S. Kay.  Fundamentals of statistical signal processing: estimation theory , 1993 .

[51]  Andrea Cavallaro,et al.  Multi-Camera Networks: Principles and Applications , 2009 .

[52]  Michael I. Jordan,et al.  Graphical Models, Exponential Families, and Variational Inference , 2008, Found. Trends Mach. Learn..

[53]  Giorgio Battistelli,et al.  Consensus CPHD Filter for Distributed Multitarget Tracking , 2013, IEEE Journal of Selected Topics in Signal Processing.

[54]  LI X.RONG,et al.  Survey of maneuvering target tracking. Part I. Dynamic models , 2003 .

[55]  Brendan J. Frey,et al.  Factor graphs and the sum-product algorithm , 2001, IEEE Trans. Inf. Theory.

[56]  H.-A. Loeliger,et al.  An introduction to factor graphs , 2004, IEEE Signal Process. Mag..

[57]  Hichem Snoussi,et al.  Distributed Variational Filtering for Simultaneous Sensor Localization and Target Tracking in Wireless Sensor Networks , 2012, IEEE Transactions on Vehicular Technology.

[58]  Young-Koo Lee,et al.  Broadcast gossip based distributed hypothesis testing in wireless sensor networks , 2009, 2009 International Conference on Advanced Technologies for Communications.

[59]  Y. Bar-Shalom,et al.  The probabilistic data association filter , 2009, IEEE Control Systems.

[60]  Erwin Riegler,et al.  Simultaneous distributed sensor self-localization and target tracking using belief propagation and likelihood consensus , 2012, 2012 Conference Record of the Forty Sixth Asilomar Conference on Signals, Systems and Computers (ASILOMAR).

[61]  Paolo Braca,et al.  Asymptotic Efficiency of the PHD in Multitarget/Multisensor Estimation , 2013, IEEE Journal of Selected Topics in Signal Processing.

[62]  Henk Wymeersch,et al.  Distributed Estimation With Information-Seeking Control in Agent Networks , 2014, IEEE Journal on Selected Areas in Communications.

[63]  Richard M. Murray,et al.  Consensus problems in networks of agents with switching topology and time-delays , 2004, IEEE Transactions on Automatic Control.

[64]  Giorgio Battistelli,et al.  Consensus Labeled Random Finite Set Filtering for Distributed Multi-Object Tracking , 2015, ArXiv.