Skip to main content

Distributed Cooperative Localization with Efficient Pairwise Range Measurements

  • Conference paper
  • First Online:
Distributed Autonomous Robotic Systems (DARS 2021)

Part of the book series: Springer Proceedings in Advanced Robotics ((SPAR,volume 22))

Included in the following conference series:

  • 875 Accesses

Abstract

We present a method based on covariance intersection for cooperative localization with pairwise range-only relative measurements. Our method was designed for underwater robots equipped with an acoustic communication and ranging system. Range measurements are not sufficient to compute a complete relative 3D position. Therefore, covariance intersection is performed in a transformed space along their relative estimated positions, while preserving cross-correlations between other state variables. Given the characteristics of the acoustic channel, only one robot can transmit data or a ranging request at a time, hence the pairwise limitation. We also present a heuristic for choosing a peer robot for a range measurement by maximizing mutual information. Our method places no further restrictions on the order, timing or scheduling of relative measurements. We evaluated our method for accuracy and consistency, and present results from simulations as well as outdoor experiments.

This is a preview of subscription content, log in via an institution to check access.

Access this chapter

Subscribe and save

Springer+ Basic
$34.99 /Month
  • Get 10 units per month
  • Download Article/Chapter or eBook
  • 1 Unit = 1 Article or 1 Chapter
  • Cancel anytime
Subscribe now

Buy Now

Chapter
USD 29.95
Price excludes VAT (USA)
  • Available as PDF
  • Read on any device
  • Instant download
  • Own it forever

Tax calculation will be finalised at checkout

Purchases are for personal use only

Institutional subscriptions

Similar content being viewed by others

References

  1. Quraishi, A., Bahr, A., Schill, F., Martinoli, A.: A flexible navigation support system for a team of underwater robots. In: International Symposium on Multi-Robot and Multi-Agent Systems, pp. 70–75 (2019)

    Google Scholar 

  2. Bahr, A., Leonard, J.J., Fallon, M.F.: Cooperative localization for autonomous underwater vehicles. Int. J. Robot. Res. 28(6), 714–728 (2009)

    Article  Google Scholar 

  3. Thrun, S., Burgard, W., Fox, D.: Probabilistic Robotics. MIT Press, Cambridge (2005)

    MATH  Google Scholar 

  4. Borenstein, J.: Experimental results from internal odometry error correction with the OmniMate mobile robot. IEEE Trans. Robot. Autom. 14(6), 963–969 (1998)

    Article  Google Scholar 

  5. Roumeliotis, S.I., Bekey, G.A.: Distributed multirobot localization. IEEE Trans. Robot. Autom. 18(5), 781–795 (2002)

    Article  Google Scholar 

  6. Luft, L., Schubert, T., Roumeliotis, S.I., Burgard, W.: Recursive decentralized localization for multi-robot systems with asynchronous pairwise communication. Int. J. Robot. Res. 37(10), 1152–1167 (2018)

    Article  Google Scholar 

  7. Panzieri, S., Pascucci, F., Setola, R.: Multirobot localisation using interlaced extended Kalman filter. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 2816–2821 (2006)

    Google Scholar 

  8. Julier, S.J., Uhlmann, J.K.: A non-divergent estimation algorithm in the presence of unknown correlations. In: Proceedings of the 1997 American Control Conference (Cat. No.97CH36041), vol. 4, pp. 2369–2373 (1997)

    Google Scholar 

  9. Howard, A, Matarić, M.J., Sukhatme, G.S.: Localization for mobile robot teams using maximum likelihood estimation. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, vol. 1, pp. 434–439 (2002)

    Google Scholar 

  10. Howard, A., Matarić, M.J., Sukhatme, G.S.: Localization for mobile robot teams: a distributed MLE approach. In: Siciliano, B., Dario, P. (eds.) Experimental Robotics VIII. Springer Tracts in Advanced Robotics, vol. 5, pp. 146–155. Springer, Berlin Heidelberg (2003). https://doi.org/10.1007/3-540-36268-1_12

    Chapter  Google Scholar 

  11. Klingner, J., Ahmed, N., Correll, N.: Fault-tolerant covariance intersection for localizing robot swarms. Robot. Auton. Syst. 122, 103–306 (2019)

    Article  Google Scholar 

  12. Carrillo-Arce, L.C., Nerurkar, E.D., Gordillo, J.L., Roumeliotis, S.I.: Decentralized multi-robot cooperative localization using covariance intersection. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 1412–1417, November 2013

    Google Scholar 

  13. Vasic, M., Mansolino, D., Martinoli, A.: A system implementation and evaluation of a cooperative fusion and tracking algorithm based on a Gaussian Mixture PHD filter. In: 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 4172–4179 (2016)

    Google Scholar 

  14. Li, H., Nashashibi, F., Yang, M.: Split covariance intersection filter: theory and its application to vehicle localization. IEEE Trans. Intell. Transp. Syst. 14(4), 1860–1871 (2013)

    Article  Google Scholar 

  15. Li, H., Nashashibi, F.: Cooperative multi-vehicle localization using split covariance intersection filter. IEEE Intell. Transp. Syst. Mag. 5(2), 33–44 (2013)

    Article  Google Scholar 

  16. Park, J., Lee, J.: Beacon selection and calibration for the efficient localization of a mobile robot, vol. 32, no. 1, pp. 115–131. Cambridge University Press (2014)

    Google Scholar 

  17. Wang, H., Yao, K., Pottie, G., Estrin, D.: Entropy-based sensor selection heuristic for target localization. In: Proceedings of the 3rd International Symposium on Information Processing in Sensor Networks, pp. 36–45 (2004)

    Google Scholar 

  18. Ertin, E., Fisher, J.W., Potter, L.C.: Maximum mutual information principle for dynamic sensor query problems. In: Zhao, F., Guibas, L. (eds.) IPSN 2003. LNCS, vol. 2634, pp. 405–416. Springer, Heidelberg (2003). https://doi.org/10.1007/3-540-36978-3_27

    Chapter  MATH  Google Scholar 

  19. Pursell, L., Trimble, S.Y.: Gram-Schmidt orthogonalization by gauss elimination. Am. Math. Mon. 98(6), 544–549 (1991)

    Article  MathSciNet  Google Scholar 

  20. Simon, D., Simon, D.L.: Constrained Kalman filtering via density function truncation for turbofan engine health estimation. Int. J. Syst. Sci. 41(2), 159–171 (2010)

    Article  MathSciNet  Google Scholar 

  21. Cover, T.M., Thomas, J.A.: Elements of Information Theory. Wiley, Hoboken (1991)

    Book  Google Scholar 

  22. Michel, O.: Cyberbotics LTD. Webots TM: professional mobile robot simulation. Int. J. Adv. Rob. Syst. 1(1), 39–42 (2004)

    Google Scholar 

  23. Schill, F., Bahr, A., Martinoli, A.: Vertex: a new distributed underwater robotic platform for environmental monitoring. In: Groß, R., et al. (eds.) Distributed Autonomous Robotic Systems. SPAR, vol. 6, pp. 679–693. Springer, Cham (2018). https://doi.org/10.1007/978-3-319-73008-0_47

    Chapter  Google Scholar 

  24. Bar-Shalom, Y., Li, X.R., Kirubarajan, T.: Estimation with Applications to Tracking and Navigation: Theory Algorithms and Software. Wiley, Hoboken (2004)

    Google Scholar 

Download references

Acknowledgement

This work was partially funded by the Swiss National Science Foundation under grant CRSII2_160726/1.

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Anwar Quraishi .

Editor information

Editors and Affiliations

Rights and permissions

Reprints and permissions

Copyright information

© 2022 The Author(s), under exclusive license to Springer Nature Switzerland AG

About this paper

Check for updates. Verify currency and authenticity via CrossMark

Cite this paper

Quraishi, A., Martinoli, A. (2022). Distributed Cooperative Localization with Efficient Pairwise Range Measurements. In: Matsuno, F., Azuma, Si., Yamamoto, M. (eds) Distributed Autonomous Robotic Systems. DARS 2021. Springer Proceedings in Advanced Robotics, vol 22. Springer, Cham. https://doi.org/10.1007/978-3-030-92790-5_11

Download citation

Publish with us

Policies and ethics