Decentralized State Estimation: An Approach using Pseudomeasurements and Preintegration (2304.04036v3)
Abstract: This paper addresses the problem of decentralized, collaborative state estimation in robotic teams. In particular, this paper considers problems where individual robots estimate similar physical quantities, such as each other's position relative to themselves. The use of pseudomeasurements is introduced as a means of modelling such relationships between robots' state estimates, and is shown to be a tractable way to approach the decentralized state estimation problem. Moreover, this formulation easily leads to a general-purpose observability test that simultaneously accounts for measurements that robots collect from their own sensors, as well as the communication structure within the team. Finally, input preintegration is proposed as a communication-efficient way of sharing odometry information between robots, and the entire theory is appropriate for both vector-space and Lie-group state definitions. To overcome the need for communicating preintegrated-covariance information, a deep autoencoder is proposed that reconstructs the covariance information from the inputs, hence further reducing the communication requirements. The proposed framework is evaluated on three different simulated problems, and one experiment involving three quadcopters.
- In: Intl. Conf. on Intelligent Robots and Systems. Kyoto, pp. 8544–8551.
- Allak E, Jung R and Weiss S (2019) Covariance Pre-Integration for Delayed Measurements in Multi-Sensor Fusion. In: Intl. Conf. on Intelligent Robots and Systems. Macau, pp. 6642–6649.
- Arambel PO, Rago C and Mehra RK (2001) Covariance intersection algorithm for distributed spacecraft state estimation. Proc. Am. Control Conf. 6: 4398–4403.
- Bar-Shalom Y, Li XR and Kirubarajan T (2001) Estimation with Applications to Tracking and Navigation. New York: John Wiley & Sons, Inc.
- Barfoot TD (2023) State Estimation for Robotics. 2nd edition. Cambridge University Press.
- Barfoot TD and Furgale PT (2014) Associating Uncertainty with Three-Dimensional Poses for use in Estimation Problems. IEEE Trans. on Robotics 30(3): 679–693.
- Barrau A and Bonnabel S (2019) Linear observed systems on groups. Systems and Control Letters 129: 36–42.
- IEEE Trans. on Automatic Control 60(5): 1410–1415.
- Journal of Mathematical Imaging and Vision 55(3): 284–303.
- IEEE Trans. Robotics 38(2): 998–1015.
- In: International Conference on Intelligent Robots and Systems. Tokyo, pp. 1412–1417.
- Eckenhoff K, Geneva P and Huang G (2019) Closed-form preintegration methods for graph-based visual–inertial navigation. International Journal of Robotics Research 38(5): 563–586.
- IEEE Trans. Robotics 33(1): 1–21.
- Grime S and Durrant-Whyte HF (1994) Data fusion in decentralized sensor networks (Information Filter). Control Engineering Practice 2(5): 849–863.
- Autonomous Robots 30(1): 99–122.
- Julier S (2001) General Decentralized Data Fusion with Covariance Intersection (CI). In: Multisensor Data Fusion, chapter 12. pp. 269–294.
- Julier SJ and Uhlmann JK (1997) A non-divergent estimation algorithm in the presence of unknown correlations. In: American Control Conference, volume 4. Albuquerque, pp. 2369–2373.
- Jung R, Brommer C and Weiss S (2020) Decentralized Collaborative State Estimation for Aided Inertial Navigation. In: Intl. Conf. on Robotics and Automation. Paris, pp. 4673–4679.
- Lajoie PY and Beltrame G (2023) Swarm-SLAM : Sparse Decentralized Collaborative Simultaneous Localization and Mapping Framework for Multi-Robot Systems URL http://arxiv.org/abs/2301.06230.
- Leung KY, Barfoot TD and Liu HH (2010) Decentralized localization of sparsely-communicating robot networks: A centralized-equivalent approach. IEEE Trans. Robotics 26(1): 62–77.
- Leung KY, Barfoot TD and Liu HH (2012) Decentralized cooperative SLAM for sparsely-communicating robot networks: A centralized-equivalent approach. J Intell. and Robot Syst. 66(3): 321–342.
- Li H and Nashashibi F (2013) Cooperative Multi-Vehicle Localization Using Split Covariance Intersection Gilter. IEEE Intelligent Transportation Systems Magazine 5(2): 33–44.
- Li L and Yang M (2021) Joint localization based on split covariance intersection on the lie group. IEEE Trans. Robotics 37(5): 1508–1524.
- Intl Journal of Robotics Research 37(10): 1152–1167.
- Lupton T and Sukkarieh S (2012) Visual-inertial-aided navigation for high-dynamic motion in built environments without initial conditions. IEEE Trans. Robotics 28(1): 61–76.
- Olfati-Saber R (2005) Distributed Kalman filter with embedded consensus filters. IEEE Conf. Decis. Control. Eur. Control Conf. : 8179–8184.
- Olfati-Saber R and Murray RM (2004) Consensus problems in networks of agents with switching topology and time-delays. IEEE Trans. on Automatic Control 49(9): 1520–1533.
- IFAC Proceedings Volumes 46(2): 421–426.
- Psiaki ML (2013) The blind tricyclist problem and a comparative study of nonlinear filters: A challenging benchmark for evaluating nonlinear estimation methods. IEEE Control Systems Magazine 33(3): 40–54.
- Roumeliotis SI and Bekey GA (2002) Distributed multirobot localization. IEEE Trans. Robotics and Auto. 18(5): 781–795.
- IEEE Robotics and Automation Letters 6(3): 4955–4961.
- IEEE Robotics and Automation Letters 6(3): 4758–4765.
- URL https://arxiv.org/abs/2210.05888v2.
- Solà J, Deray J and Atchuthan D (2018) A Micro Lie Theory for State Estimation in Robotics. URL http://arxiv.org/abs/1812.01537.
- IEEE Transactions on Robotics 38(4): 2022–2038.
- In: IEEE Intl. Conf. on Robotics and Automation. Paris, pp. 8776–8782.
- Zhu J and Kia SS (2019) Cooperative Localization under Limited Connectivity. IEEE Transactions on Robotics 35(6): 1523–1530.