0
SPECIAL SECTION PAPERS

Distributed Bayesian Filter Using Measurement Dissemination for Multiple Unmanned Ground Vehicles With Dynamically Changing Interaction Topologies

[+] Author and Article Information
Chang Liu

Department of Mechanical Engineering,
University of California, Berkeley,
Berkeley, CA 94720
e-mail: changliu@berkeley.edu

Shengbo Eben Li

Department of Automotive Engineering,
State Key Lab of Automotive Safety and Energy,
Tsinghua University,
Beijing 100084, China
e-mail: lisb04@gmail.com

Diange Yang

Department of Automotive Engineering,
State Key Lab of Automotive Safety and Energy,
Tsinghua University,
Beijing 100084, China
e-mail: ydg@tsinghua.edu.cn

J. Karl Hedrick

Department of Mechanical Engineering,
University of California, Berkeley,
Berkeley, CA 94720
e-mail: khedrick@me.berkeley.edu

1Corresponding author.

Contributed by the Dynamic Systems Division of ASME for publication in the JOURNAL OF DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL. Manuscript received February 14, 2017; final manuscript received June 16, 2017; published online November 8, 2017. Assoc. Editor: Prashant Mehta.

J. Dyn. Sys., Meas., Control 140(3), 030903 (Nov 08, 2017) (11 pages) Paper No: DS-17-1086; doi: 10.1115/1.4037779 History: Received February 14, 2017; Revised June 16, 2017

This paper presents a novel distributed Bayesian filtering (DBF) method using measurement dissemination (MD) for multiple unmanned ground vehicles (UGVs) with dynamically changing interaction topologies. Different from statistics dissemination (SD)-based algorithms that transmit posterior distributions or likelihood functions, this method relies on a full-in and full-out (FIFO) transmission protocol, which significantly reduces the transmission burden between each pair of UGVs. Each UGV only sends a communication buffer (CB) and a track list (TL) to its neighbors, in which the former contains a history of sensor measurements from all UGVs, and the latter is used to trim the redundant measurements in the CB to reduce communication overhead. It is proved that by using FIFO, each UGV can disseminate its measurements over the whole network within a finite time, and the FIFO-based DBF is able to achieve consistent estimation of the environment state. The effectiveness of this method is validated by comparing with the consensus-based distributed filter (CbDF) and the centralized filter (CF) in a multitarget tracking problem.

FIGURES IN THIS ARTICLE
<>
Copyright © 2018 by ASME
Your Session has timed out. Please sign back in to continue.

References

Hedrick, J. K. , Basso, B. , Love, J. , and Lavis, B. M. , 2011, “ Tools and Techniques for Mobile Sensor Network Control,” ASME J. Dyn. Syst. Meas. Control, 133(2), p. 024001. [CrossRef]
Chamberland, J.-F. , and Veeravalli, V. V. , 2007, “ Wireless Sensors in Distributed Detection Applications,” IEEE Signal Process. Mag., 24(3), pp. 16–25. [CrossRef]
Atanasov, N. A. , Le Ny, J. , and Pappas, G. J. , 2015, “ Distributed Algorithms for Stochastic Source Seeking With Mobile Robot Networks,” ASME J. Dyn. Syst. Meas. Control, 137(3), p. 031004.
Madhag, A. , and Choi, J. , 2017, “ A Distributed Navigation Strategy for Mobile Sensor Networks With the Probabilistic Wireless Links,” ASME J. Dyn. Syst. Meas. Control, 139(3), p. 031004. [CrossRef]
Thrun, S. , Burgard, W. , and Fox, D. , 2005, Probabilistic Robotics, MIT Press, Cambridge, MA.
Bandyopadhyay, S. , and Chung, S.-J. , 2014, “ Distributed Estimation Using Bayesian Consensus Filtering,” American Control Conference (ACC), Portland, OR, June 4–6, pp. 634–641.
Julian, B. J. , Angermann, M. , Schwager, M. , and Rus, D. , 2012, “ Distributed Robotic Sensor Networks: An Information-Theoretic Approach,” Int. J. Rob. Res., 31(10), pp. 1134–1154. [CrossRef]
Chen, Z. , 2003, “ Bayesian Filtering: From Kalman Filters to Particle Filters, and Beyond,” Statistics, 182(1), pp. 1–69. http://www.dsi.unifi.it/users/chisci/idfric/Nonlinear_filtering_Chen.pdf
Zheng, Y. , Li, S. E. , Li, K. , and Wang, L.-Y. , 2016, “ Stability Margin Improvement of Vehicular Platoon Considering Undirected Topology and Asymmetric Control,” IEEE Trans. Control Syst. Technol., 24(4), pp. 1253–1265. [CrossRef]
Zheng, Y. , Li, S. E. , Li, K. , Borrelli, F. , and Hedrick, J. K. , 2017, “ Distributed Model Predictive Control for Heterogeneous Vehicle Platoons Under Unidirectional Topologies,” IEEE Trans. Control Syst. Technol., 25(3), pp. 899–910. [CrossRef]
Zuo, L. , Mehrotra, K. , Varshney, P. K. , and Mohan, C. K. , 2006, “ Bandwidth-Efficient Target Tracking in Distributed Sensor Networks Using Particle Filters,” Ninth International Conference on Information Fusion (ICIF), Florence, Italy, July 10–13, pp. 1–4.
Vemula, M. , Bugallo, M. F. , and Djurić, P. M. , 2006, “ Target Tracking in a Two-Tiered Hierarchical Sensor Network,” IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP), Toulouse, France, May 14–19.
Jadbabaie, A. , Lin, J. , and Morse, A. S. , 2003, “ Coordination of Groups of Mobile Autonomous Agents Using Nearest Neighbor Rules,” IEEE Trans. Autom. Control, 48(6), pp. 988–1001. [CrossRef]
Ren, W. , and Beard, R. W. , 2005, “ Consensus Seeking in Multiagent Systems Under Dynamically Changing Interaction Topologies,” IEEE Trans. Autom. Control, 50(5), pp. 655–661. [CrossRef]
Olfati-Saber, R. , Fax, A. , and Murray, R. M. , 2007, “ Consensus and Cooperation in Networked Multi-Agent Systems,” Proc. IEEE, 95(1), pp. 215–233. [CrossRef]
Hlinka, O. , Hlawatsch, F. , and Djuric, P. M. , 2013, “ Distributed Particle Filtering in Agent Networks: A Survey, Classification, and Comparison,” IEEE Signal Process. Mag., 30(1), pp. 61–81. [CrossRef]
Madhavan, R. , Fregene, K. , and Parker, L. E. , 2004, “ Distributed Cooperative Outdoor Multirobot Localization and Mapping,” Auton. Rob., 17(1), pp. 23–39. [CrossRef]
Olfati-Saber, R. , 2005, “ Distributed Kalman Filter With Embedded Consensus Filters,” 44th IEEE Conference on Decision and Control and European Control Conference (CDC-ECC), Seville, Spain, Dec. 12–15, pp. 8179–8184.
Gu, D. , 2007, “ Distributed Particle Filter for Target Tracking,” IEEE International Conference on Robotics and Automation (ICRA), Rome, Italy, Apr. 10–14, pp. 3856–3861.
Hlinka, O. , Slučiak, O. , Hlawatsch, F. , Djurić, P. M. , and Rupp, M. , 2012, “ Likelihood Consensus and Its Application to Distributed Particle Filtering,” IEEE Trans. Signal Process., 60(8), pp. 4334–4349. [CrossRef]
Beaudeau, J. , Bugallo, M. F. , and Djuric, P. M. , 2012, “ Target Tracking With Asynchronous Measurements by a Network of Distributed Mobile Agents,” IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP), Kyoto, Japan, Mar. 25–30, pp. 3857–3860.
Sheng, X. , Hu, Y.-H. , and Ramanathan, P. , 2005, “ Distributed Particle Filter With GMM Approximation for Multiple Targets Localization and Tracking in Wireless Sensor Network,” Fourth International Symposium on Information Processing in Sensor Networks (IPSN), Los Angeles, CA, Apr. 25–27, pp. 181–188.
Coates, M. , 2004, “ Distributed Particle Filters for Sensor Networks,” Third International Symposium on Information Processing in Sensor Networks (IPSN), Berkeley, CA, Apr. 26–27, pp. 99–107.
Ribeiro, A. , and Giannakis, G. B. , 2006, “ Bandwidth-Constrained Distributed Estimation for Wireless Sensor Networks—Part II: Unknown Probability Density Function,” IEEE Trans. Signal Process., 54(7), pp. 2784–2796. [CrossRef]
Djurić, P. M. , Beaudeau, J. , and Bugallo, M. F. , 2011, “ Non-Centralized Target Tracking With Mobile Agents,” IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP), Prague, Czech Republic, May 22–27, pp. 5928–5931.
Xiao, F. , and Wang, L. , 2008, “ Asynchronous Consensus in Continuous-Time Multi-Agent Systems With Switching Topology and Time-Varying Delays,” IEEE Trans. Autom. Control, 53(8), pp. 1804–1816. [CrossRef]
Gao, F. , Li, S. E. , Zheng, Y. , and Kum, D. , 2016, “ Robust Control of Heterogeneous Vehicular Platoon With Uncertain Dynamics and Communication Delay,” IET Intell. Transp. Syst., 10(7), pp. 503–513. [CrossRef]
Xia, Y. , Shang, J. , Chen, J. , and Liu, G.-P. , 2009, “ Networked Data Fusion With Packet Losses and Variable Delays,” IEEE Trans. Syst. Man Cybern. Part B, 39(5), pp. 1107–1120. [CrossRef]
Leung, K. Y. , Barfoot, T. D. , and Liu, H. H. , 2010, “ Decentralized Localization of Sparsely-Communicating Robot Networks: A Centralized-Equivalent Approach,” IEEE Trans. Rob., 26(1), pp. 62–77. [CrossRef]
Liu, C. , Li, S. , and Hedrick, J. K. , 2017, “ Measurement Dissemination-Based Distributed Bayesian Filter Using the Latest-in-and-Full-Out Exchange Protocol for Networked Unmanned Vehicles,” IEEE Trans. Ind. Electron., PP(99), p. 1.
Liu, C. , Li, S. E. , and Hedrick, J. K. , 2016, “ Distributed Target Localization Using a Group of UGVS Under Dynamically Changing Interaction Topologies,” American Control Conference (ACC), Boston, MA, July 6–8, pp. 2585–2590.
Liu, C. , Li, S. E. , and Hedrick, J. K. , 2017, “ Distributed Bayesian Filters for Multi-Vehicle Network by Using Latest-in-and-Full-Out Exchange Protocol of Observations,” American Control Conference (ACC), Seattle, WA, May 24–26, pp. 4908–4913.
Kitagawa, G. , 1996, “ Monte Carlo Filter and Smoother for Non-Gaussian Nonlinear State Space Models,” J. Comput. Graphical Stat., 5(1), pp. 1–25. http://www.tandfonline.com/doi/citedby/10.1080/10618600.1996.10474692?scroll=top&needAccess=true
Bishop, A. N. , Fidan, B. , Anderson, B. D. , Doğançay, K. , and Pathirana, P. N. , 2010, “ Optimality Analysis of Sensor-Target Localization Geometries,” Automatica, 46(3), pp. 479–492. [CrossRef]
Furukawa, T. , Bourgault, F. , Lavis, B. , and Durrant-Whyte, H. F. , 2006, “ Recursive Bayesian Search-and-Tracking Using Coordinated Uavs for Lost Targets,” IEEE International Conference on Robotics and Automation (ICRA), Orlando, FL, May 15–19, pp. 2521–2526.
Amemiya, T. , 1985, Advanced Econometrics, Harvard University Press, Cambridge, MA.
Malanowski, M. , and Kulpa, K. , 2012, “ Two Methods for Target Localization in Multistatic Passive Radar,” IEEE Trans. Aerosp. Electron. Syst., 48(1), pp. 572–580. [CrossRef]
Olfati-Saber, R. , Franco, E. , Frazzoli, E. , and Shamma, J. , 2006, “ Belief Consensus and Distributed Hypothesis Testing in Sensor Networks,” Networked Embedded Sensing and Control, Springer, Berlin, pp. 169–182.
Veeravalli, V. V. , and Varshney, P. K. , 2012, “ Distributed Inference in Wireless Sensor Networks,” Philos. Trans. R. Soc. London A, 370(1958), pp. 100–117. [CrossRef]

Figures

Grahic Jump Location
Fig. 1

Target tracking scenario. The interaction topology is dynamically changing and UGVs can only communicate with neighboring UGVs.

Grahic Jump Location
Fig. 2

Example of FIFO with three UGVs under dynamically changing interaction topologies. The arrows represent a directed communication link between two UGVs. ø denotes the empty set. For the purpose of clarity, we only show measurements, not the states, in the CB.

Grahic Jump Location
Fig. 3

Example of FIFO-DBF for the first UGV at time k. Only the measurement (not the state) is shown in the figure. The UGV first calculates Ptmp1(Xt+1). Since the UGV has received all UGVs' measurements of t+1, the Ptmp1(Xt+1) is assigned as the new stored PDF. The dashed arrow on the right shows the order to fuse measurements in the CB.

Grahic Jump Location
Fig. 4

Example of updating TLs. For the first UGV's TL, the jth(j∈V) entry on the ith(i∈V) row represents this UGV's knowledge about whether the ith UGV has received the jth UGV's state-measurement pair of time k1i, where k1i is the last entry of the ith row. TLs are updated using Algorithm 3.

Grahic Jump Location
Fig. 5

The dynamically changing interaction topologies used in the simulation: (a)–(d) four types of topologies; (e) the union of these topologies is jointly strongly connected. The bottom axis shows a randomly generated sequence of topologies that satisfy the frequently jointly strongly connectedness condition.

Grahic Jump Location
Fig. 6

Evolution of the first UGV's target estimation using FIFO-DBF. The colorful background represents the sum of the individual PDF of three targets. (a) FIFO-DBF at step 3, (b) FIFO-DBF at step 5, (c) FIFO-DBF at step 7, (d) FIFO-DBF at step 10, (e) FIFO-DBF at step 20, and (f) FIFO-DBF at step 40.

Grahic Jump Location
Fig. 7

The first UGV's target estimation using (a) CbDF and (b) CF. The estimation uncertainty remains large for CbDF: (a) CbDF at step 40 and (b) CF at step 40.

Grahic Jump Location
Fig. 8

The average estimation error (a), (c), (e) and the average entropy (b), (d), (f) of ten trials using different filtering approaches. The dotted lines correspond to the results of FIFO-DBF by the six UGVs (“U1”–“U6” in the legends). (a) position error of target 1, (b) entropy of target 1, (c) position error of target 2, (d) entropy of target 2, (e) position error of target 3, and (f) entropy of target 3.

Tables

Errata

Discussions

Some tools below are only available to our subscribers or users with an online account.

Related Content

Customize your page view by dragging and repositioning the boxes below.

Related Journal Articles
Related eBook Content
Topic Collections

Sorry! You do not have access to this content. For assistance or to subscribe, please contact us:

  • TELEPHONE: 1-800-843-2763 (Toll-free in the USA)
  • EMAIL: asmedigitalcollection@asme.org
Sign In