Abstract
An Informed Path Planning algorithm for multiple agents is presented. It can be used to efficiently utilize available agents when surveying large areas, when total coverage is unattainable. Internally the algorithm has a Probability Hypothesis Density (PHD) representation, inspired by modern multi-target tracking methods, to represent unseen objects. Using the PHD, the expected number of observed objects is optimized. In a sequential manner, each agent maximizes the number of observed new targets, taking into account the probability of undetected objects due to previous agents’ actions and the probability of detection, which yields a scalable algorithm. Algorithm properties are evaluated in simulations, and shown to outperform a greedy base line method. The algorithm is also evaluated by applying it to a sea ice tracking problem, using two datasets collected in the Arctic, with reasonable results. An implementation is provided under an Open Source license.
Similar content being viewed by others
Notes
The LMB tracker used is available as Free and Open Source Software (FOSS) at https://github.com/jonatanolofsson/clmb. The planner described in this chapter is available at https://github.com/jonatanolofsson/phdplanner.
References
Brekke, E., & Chitre, M. (2018). Relationship between finite set statistics and the multiple hypothesis tracker. IEEE Transactions on Aerospace and Electronic Systems, 9251, 1–15. https://doi.org/10.1109/TAES.2018.2805178.
Chekuri, C., & Pál, M. (2005). A recursive greedy algorithm for walks in directed graphs. In Proceedings—Annual IEEE Symposium on Foundations of Computer Science, FOCS, Pittsburgh, PA, USA (pp. 245–253). https://doi.org/10.1109/SFCS.2005.9.
Chen, S. G. (2014). Reduced recursive inclusion-exclusion principle for the probability of union events. In IEEE International Conference on Industrial Engineering and Engineering Management, Bandar Sunway, Malaysia (pp. 5–7). https://doi.org/10.1109/IEEM.2014.7058590.
Dames, P. (2017). Distributed multi-target search and tracking using the PHD filter. In. 2017 International Symposium on Multi-Robot and Multi-Agent Systems (MRS). IEEE. https://doi.org/10.1109/mrs.2017.8250924.
Dames, P. (2019). Distributed multi-target search and tracking using the PHD filter. Autonomous Robots. https://doi.org/10.1007/s10514-019-09840-9.
Fiorelli, E., Leonard, N. E., Bhatta, P., Paley, D. A., Bachmayer, R., & Fratantoni, D. M. (2006). Multi-AUV control and adaptive sampling in Monterey Bay. IEEE Journal of Oceanic Engineering, 31(4), 935–948. https://doi.org/10.1109/JOE.2006.880429.
Galceran, E., & Carreras, M. (2013). A survey on coverage path planning for robotics. Robotics and Autonomous Systems, 61(12), 1258–1276. https://doi.org/10.1016/j.robot.2013.09.004.
Gordon, N., Salmond, D., & Smith, A. (1993). Novel approach to nonlinear/non-Gaussian Bayesian state estimation. In IEE Proceedings F—Radar and Signal Processing (Vol. 140, No. 2, p. 107). https://doi.org/10.1049/ip-f-2.1993.0015.
Granström, K., & Lundquist. (2012). Extended target tracking using PHD filters. Ph.D. thesis, Linköping University, Linköping.
Hollinger, G. A., & Sukhatme, G. S. (2014). Sampling-based robotic information gathering algorithms. International Journal of Robotics Research, 33(9), 1271–1287. https://doi.org/10.1177/0278364914533443.
IAMSAR. (2010). IAMSAR manual: International aeronautical and maritime search and rescue manual. IMO.
Kalman, R. E. (1960). A new approach to linear filtering and prediction problems. Journal of Basic Engineering, 82(1), 35. https://doi.org/10.1115/1.3662552.
Krause, A., & Guestrin, C. (2011). Submodularity and its applications in optimized information gathering. ACM Transactions on Intelligent Systems and Technology, 2(4), 1–20. https://doi.org/10.1145/1989734.1989736.
Mahler, R. P. S. (2003). Multitarget Bayes filtering via first-order multitarget moments. IEEE Transactions on Aerospace and Electronic Systems, 39(4), 1152–1178. https://doi.org/10.1109/TAES.2003.1261119.
Mahler, R. P. S. (2006). A theory of PHD filters of higher order in target number. In Proceedings of SPIE, Orlando, FL, USA, 6235, May 2006, pp 1–12. https://doi.org/10.1117/12.667083.
Mahler, R. P. S. (2007a). PHD filters of higher order in target number. IEEE Transactions on Aerospace and Electronic Systems, 43(4), 1523–1543. https://doi.org/10.1109/TAES.2007.4441756.
Mahler, R. P. S. (2007b). Statistical multisource-multitarget information fusion. Norwood: Artech House, Inc.
Mahler, R. P. S., & Zajic, T. (2001). Multitarget filtering using a multitarget first-order moment statistic. In Proceedings of SPIE (Vol. 4380). https://doi.org/10.1117/12.436947.
Mitchell, M. (1996). An introduction to genetic algorithms. Computers & Mathematics with Applications, 32(6), 133. https://doi.org/10.1016/S0898-1221(96)90227-8.
Olofsson, J., Brekke, E., Fossen, T. I., & Johansen, T. A. (2017a). Spatially indexed clustering for scalable tracking of remotely sensed drift ice. In IEEE Aerospace Conference Proceedings, Big Sky, MT, USA.
Olofsson, J., Veibäck, C., & Hendeby, G. (2017b). Sea ice tracking with a spatially indexed labeled multi-Bernoulli filter. In 20th International Conference on Information Fusion (FUSION), Xi’an, China.
Pasha, A., Vo, B. N., Tuan, H. D., & Mat, W. K. (2006). Closed form PHD filtering for linear jump Markov models. In International Conference on Information Fusion (FUSION), Florence, Italy. https://doi.org/10.1109/ICIF.2006.301593.
Reid, D. B. (1979). An algorithm for tracking multiple targets. IEEE Transactions on Automatic Control, 24(6), 843–854. https://doi.org/10.1109/CDC.1978.268125.
Reuter, S., Vo, B. T., Vo, B. N., & Dietmayer, K. (2014). The labeled multi-Bernoulli filter. IEEE Transactions on Signal Processing, 62(12), 3246–3260. https://doi.org/10.1109/LSP.2015.2414274.
Sidenbladh, H. (2003). Multi-target particle filtering for the probability hypothesis density. In Proceedings of the 6th International Conference of Information Fusion, Queensland Australia (Vol. 2, pp. 800–806). https://doi.org/10.1109/ICIF.2003.177321.
Singh, A., Krause, A., Guestrin, C., & Kaiser, W. J. (2009). Efficient informative sensing using multiple robots. Journal of Artificial Intelligence Research, 34, 707–755. https://doi.org/10.1613/jair.2674. arXiv:1401.3462.
Skoglar, P. (2012). Tracking and planning for surveillance applications. Ph.D. thesis, Linköping University.
Streit, R. (2017). How I learned to stop worrying about a thousand and one filters and love analytic combinatorics. In IEEE Aerospace Conference Proceedings, Big Sky, MT, USA. https://doi.org/10.1109/AERO.2017.7943644.
Vo, B. T., Vo, B. N., & Cantoni, A. (2006). The cardinalized probability hypothesis density filter for linear Gaussian multi-target models. In 2006 40th Annual Conference on Information Sciences and Systems, Princeton, New Jersey, USA, pp. 681–686. https://doi.org/10.1109/CISS.2006.286554.
Vo, B. T., Vo, B. N., & Cantoni, A. (2007). On multi-Bernoulli approximations to the Bayes multi-target filter. In Proceedings of the 10th International Conference on Information Fusion, FUSION 2007, Québec, Canada.
Vo, B. N., & Ma, W. K. (2006). The Gaussian mixture probability hypothesis density filter. IEEE Transactions on Signal Processing, 54(11), 4091–4104. https://doi.org/10.1109/TSP.2006.881190.
Vo, B. T., & Vo, B. N. (2013). Labeled random finite sets and multi-object conjugate priors. IEEE Transactions on Signal Processing, 61(13), 3460–3475. https://doi.org/10.1109/TSP.2013.2259822. arXiv:1312.2372v1.
Vo, B. T., Vo, B. N., & Cantoni, A. (2009). The cardinality balanced multi-target multi-Bernoulli filter and its implementations. IEEE Transactions on Signal Processing, 57(2), 409–423. https://doi.org/10.1109/TSP.2008.2007924.
Vo, B. N., Vo, B. T., & Phung, D. (2014). Labeled random finite sets and the Bayes multi-target tracking filter. IEEE Transactions on Signal Processing, 62(24), 6554–6567. https://doi.org/10.1109/TSP.2014.2364014x. arXiv:1312.2372v1.
Wiener, N. (1965). Cybernetics, second edition: Or the control and communication in the animal and the machine. Cambridge: The MIT Press.
Williams, J. L. (2015). Marginal multi-Bernoulli filters: RFS derivation of MHT, JIPDA, and association-based MeMBer. IEEE Transactions on Aerospace and Electronic Systems, 51(3), 1664–1687. https://doi.org/10.1109/TAES.2015.130550. arXiv:1203.2995.
Winter, C. L., & Stein, M. C. (1993). An additive theory of probabilistic evidence accrual. In Advances in Applied Mathematics.
Zivkovic, Z. (2004). Improved adaptive Gaussian mixture model for background subtraction. In Proceedings of the 17th International Conference on Pattern Recognition, Cambridge, UK. https://doi.org/10.1109/ICPR.2004.1333992.
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
This project has received funding from the European Union’s Horizon 2020 research and innovation programme under the Marie Sklodowska-Curie Grant Agreement No. 642153, as well as the Research Council of Norway through the Centres of Excellence funding scheme, Grant Number 223254 – NTNU-AMOS. G. Hendeby has been funded by the Center for Industrial Information Technology at Linköping University (CENIIT). The tri campaign was funded by the Fram Centre project Ground-based radar measurements of sea-ice, icebergs, and growlers
Rights and permissions
About this article
Cite this article
Olofsson, J., Hendeby, G., Lauknes, T.R. et al. Multi-agent informed path planning using the probability hypothesis density. Auton Robot 44, 913–925 (2020). https://doi.org/10.1007/s10514-020-09904-1
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10514-020-09904-1