Robust Localization for Multi-robot Formations: An Experimental Evaluation of an Extended GM-PHD Filter

This paper presents a thorough experimental evaluation of an extended Gaussian Mixture Probability Hypothesis Density filter which is able to provide state estimates for the maintenance of a multi-robot formation, even when the communication fails and the tracking data are insufficient for maintaining a stable formation. The filter incorporates, firstly, absolute poses exchanged by the robots, and secondly, the geometry of the desired formation. By combining communicated data, information about the formation, and sensory detections, the resulting algorithm preserves accuracy in the state estimates despite frequent occurrences of long-duration sensing occlusions, and provides the necessary state information when the communication is sporadic or suffers from short-term outage. Differently from our previous contributions, in which the tracking strategy has only been tested in simulation, in this paper we present the results of experiments with a real multi-robot system. The results confirm that the algorithm enables robust formation maintenance in cluttered environments, under conditions affected by sporadic communication and high measurement uncertainty.