A graph optimization approach to range-based relative location

Abstract

With the development of multi-robot cluster system, the research of multi-node relative pose estimation is in the ascendant. However, for the environment without GNSS or fixed anchors, the problem of relative pose estimation is still challenging. In this paper, a general algorithm and system framework based on graph optimization algorithm is proposed to fuse inter- and intra-robot measurements, as well as mobility models with sliding windows for relative attitude estimation. In order to verify the feasibility and universality of the algorithm, the algorithm has used to design a relative positioning system based on UWB positioning with a “single-node multi-tags” system structure, which can simultaneously obtain reliable relative positions and directions. The design of multi-source fusion can further improve the accuracy and robustness of relative positioning. Experiment results shows that in the harsh environment without GNSS and fixed anchor points, the relative pose estimation accuracy of this system can reach centi-meter level, which may be the best potential choice for relative positioning of multi robot cluster in complex environment.