Simultaneous Time Synchronization and Mutual Localization for Multi-robot System

Xiangyong Wen,Yingjian Wang,Xi Zheng,Kaiwei Wang,Chao Xu,Fei Gao
2023-11-06
Abstract:Mutual localization stands as a foundational component within various domains of multi-robot systems. Nevertheless, in relative pose estimation, time synchronization is usually underappreciated and rarely addressed, although it significantly influences estimation accuracy. In this paper, we introduce time synchronization into mutual localization to recover the time offset and relative poses between robots simultaneously. Under a constant velocity assumption in a short time, we fuse time offset estimation with our previous bearing-based mutual localization by a novel error representation. Based on the error model, we formulate a joint optimization problem and utilize semi-definite relaxation (SDR) to furnish a lossless relaxation. By solving the relaxed problem, time synchronization and relative pose estimation can be achieved when time drift between robots is limited. To enhance the application range of time offset estimation, we further propose an iterative method to recover the time offset from coarse to fine. Comparisons between the proposed method and the existing ones through extensive simulation tests present prominent benefits of time synchronization on mutual localization. Moreover, real-world experiments are conducted to show the practicality and robustness.
Robotics
What problem does this paper attempt to address?
The paper primarily addresses two key issues in multi-robot systems: time synchronization and mutual localization. Specifically: 1. **Time Synchronization Issue**: In multi-robot systems, due to unsynchronized clocks of different robots and sensor trigger delays, the timestamps of data can be inconsistent. This time offset may lead to data association errors, divergence in relative pose estimation, and even potential collapse of the entire multi-robot system. 2. **Mutual Localization Issue**: Mutual localization in multi-robot systems refers to the recovery of relative positions and orientations between robots through mutual observation. Although existing methods use mutual observation measurements (such as azimuth) between robots to achieve relative pose estimation, these methods usually do not consider the issue of time synchronization. To address the above issues, the paper proposes the following contributions: - Introducing time offset estimation into mutual localization, thereby simultaneously solving the problems of time synchronization and relative pose estimation. Based on the assumption of constant velocity over a short period, the method integrates time offset estimation with previous azimuth-based mutual localization methods and proposes a new error representation form. - Constructing a joint optimization problem and using Semi-Definite Relaxation (SDR) techniques to solve this problem, thus obtaining a globally optimal solution in polynomial time. - Designing an iterative optimization strategy that can gradually recover time offsets from coarse to fine, significantly enhancing the accuracy and range of time offset estimation. - Validating the accuracy and robustness of the proposed method through extensive simulation and real-world experiments, demonstrating excellent performance in multi-robot localization scenarios. In summary, the main goal of the paper is to improve the mutual localization performance of multi-robot systems in the presence of time offsets and to address this challenge by introducing a time synchronization mechanism.