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.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Similar content being viewed by others
References
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)
Bahr, A., Leonard, J.J., Fallon, M.F.: Cooperative localization for autonomous underwater vehicles. Int. J. Robot. Res. 28(6), 714–728 (2009)
Thrun, S., Burgard, W., Fox, D.: Probabilistic Robotics. MIT Press, Cambridge (2005)
Borenstein, J.: Experimental results from internal odometry error correction with the OmniMate mobile robot. IEEE Trans. Robot. Autom. 14(6), 963–969 (1998)
Roumeliotis, S.I., Bekey, G.A.: Distributed multirobot localization. IEEE Trans. Robot. Autom. 18(5), 781–795 (2002)
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)
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)
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)
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)
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
Klingner, J., Ahmed, N., Correll, N.: Fault-tolerant covariance intersection for localizing robot swarms. Robot. Auton. Syst. 122, 103–306 (2019)
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
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)
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)
Li, H., Nashashibi, F.: Cooperative multi-vehicle localization using split covariance intersection filter. IEEE Intell. Transp. Syst. Mag. 5(2), 33–44 (2013)
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)
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)
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
Pursell, L., Trimble, S.Y.: Gram-Schmidt orthogonalization by gauss elimination. Am. Math. Mon. 98(6), 544–549 (1991)
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)
Cover, T.M., Thomas, J.A.: Elements of Information Theory. Wiley, Hoboken (1991)
Michel, O.: Cyberbotics LTD. Webots TM: professional mobile robot simulation. Int. J. Adv. Rob. Syst. 1(1), 39–42 (2004)
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
Bar-Shalom, Y., Li, X.R., Kirubarajan, T.: Estimation with Applications to Tracking and Navigation: Theory Algorithms and Software. Wiley, Hoboken (2004)
Acknowledgement
This work was partially funded by the Swiss National Science Foundation under grant CRSII2_160726/1.
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2022 The Author(s), under exclusive license to Springer Nature Switzerland AG
About this paper
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
DOI: https://doi.org/10.1007/978-3-030-92790-5_11
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-030-92789-9
Online ISBN: 978-3-030-92790-5
eBook Packages: Intelligent Technologies and RoboticsIntelligent Technologies and Robotics (R0)