Multi-Robot Cooperative Localization: Time-Varying Unobservable Subspace Analysis and Consistent Algorithm Design

Ning Hao,Fenghua He,Yu Yao
DOI: https://doi.org/10.1007/s11424-024-4003-5
2024-01-01
Journal of Systems Science and Complexity
Abstract:This paper investigates the problem of cooperative localization (CL) for a multi-robot system (MRS) under dynamic measurement topology, which involves a group of robots collectively estimating their poses with respect to a common reference frame using ego-motion measurements and robot-to-robot relative measurements. The authors provide a theoretical analysis of the time-varying unobservable subspace and propose a consistent cooperative localization algorithm. First, the authors introduce the relative measurement graph (RMG) to represent the relative pose measurements obtained by the MRS at each instant. Then, the authors derive the local observability matrix over a time interval. An equivalent relationship is established between the local observability matrix and the spectral matrices of the RMG. Moreover, the authors present a method for constructing the unobservable subspace based on the RMG under different topology conditions. Based on this analysis, the authors design a consistent cooperative localization algorithm that satisfies the constraints of the time-varying unobservable subspace. An analytical optimal solution is derived for the constrained optimization problem. Monte Carlo numerical simulations are conducted to demonstrate the consistency and accuracy of the proposed method.
What problem does this paper attempt to address?