Abstract

Abstract—This work proposes a fully decentralized strategy for maintaining the formation rigidity of a multi-robot system using only range measurements, while still allowing the graph topology to change freely over time. In this direction, a first contribution of this work is the new concept of weighted frameworks and rigidity, and of the rigidity eigenvalue, which when positive ensures the infinitesimal rigidity of a weighted framework. We then propose a distributed algorithm for estimating a common relative position reference frame amongst a team of robots with only range measurements. This first estimation step is embedded into a subsequent distributed algorithm for estimating the rigidity eigenvalue associated with the weighted framework. The estimate of the rigidity eigenvalue is finally used to generate a local control action for each agent that both maintains the rigidity property and enforces additional constraints such as collision avoidance and sensing/communication range limits and occlusions. As an additional feature of our approach, the communication and sensing links among the robots are also left free to change over time while preserving rigidity of the whole framework. The proposed scheme is then experimentally validated with a robotic testbed consisting of 6 quadrotor UAVs operating in a cluttered environment. Index Terms—graph rigidity, decentralized control, multi-robot, distributed algorithms, distributed estimation. I.