Mutual Localization in a Multi-Robot System with Anonymous Relative Position Measures

We address the mutual localization problem for I multi-robot system, under the assumption that each robot is equipped with a sensor that provides a measure of the relative position of nearby robots without their identity. Anonymity generates a combinatorial ambiguity in the Inversion of the measure equations, leading to a multiplicity of admissible relative pose hypotheses. To solve the problem, we propose a two-stage localization system based on MultiReg, an innovative algorithm that computes on-line all the possible relative pose hypotheses, whose output is processed by a data associator and a multiple EKF to isolate and refine the best estimates. The performance of the mutual localization system is analyzed through experiments, proving the effectiveness of the method and, in particular, its robustness with respect to false positives (objects that look like robots) and false negatives (robots that are not detected) of the measure process.