Integrated cooperative localization of heterogeneous measurement swarm: A unified data-driven method

TL;DR

A distributed pose-coupling CL strategy is designed, which guarantees CL under a weakly connected directed measurement topology, representing the least restrictive condition among existing results.

Abstract

The cooperative localization (CL) problem in heterogeneous robotic systems with different measurement capabilities is investigated in this work. In practice, heterogeneous sensors lead to directed and sparse measurement topologies, whereas most existing CL approaches rely on multilateral localization with restrictive multi-neighbor geometric requirements. To overcome this limitation, we enable pairwise relative localization (RL) between neighboring robots using only mutual measurement and odometry information. A unified data-driven adaptive RL estimator is first developed to handle heterogeneous and unidirectional measurements. Based on the convergent RL estimates, a distributed pose-coupling CL strategy is then designed, which guarantees CL under a weakly connected directed measurement topology, representing the least restrictive condition among existing results. The proposed method is independent of specific control tasks and is validated through a formation control application and real-world experiments.

Figures (6)

• Figure 1: An example of measurement topology and communication topology. Left: measurement topology. Right: communication topology.
• Figure 2: Geometric relationship between the displacement and unidirectional bearing measurements of the two robots.
• Figure 3: Experiment setup. (a)Measurement topology. (b)Experimental scene.
• Figure 4: Cooperative localization estimation error of each robot $i$.
• Figure 5: Formation tracking error of each robot $i$.

Theorems & Definitions (12)

• Remark 1
• Lemma 1
• Lemma 2
• Theorem 1
• proof
• Remark 2
• Remark 3
• Definition 1
• Lemma 3
• proof