Physical Interpretation of Rigidity for Bearing Formations: Application to Mobility and Singularity Analyses

Abstract

Research on formation control and cooperative localization for multirobot systems has been an active field over the last years. A powerful theoretical framework for addressing formation control and localization, especially when exploiting onboard sensing, is that of formation rigidity (mainly studied for the cases of distance and bearing measurements). Rigidity of a formation depends not only on the topology of the sensing/communication graph but also on the spatial arrangement of the robots, since special configurations (“singularities” of the rigidity matrix), which are hard to detect in general, can cause a rigidity loss and prevent convergence of formation control/localization algorithms based on formation rigidity. The aim of this paper is to gain additional insights into the internal structure of bearing rigid formations by considering an alternative characterization of formation rigidity using tools borrowed from the mechanical engineering community. In particular, we show that bearing rigid graphs can be given a physical interpretation related to virtual mechanisms, whose mobility and singularities can be analyzed and detected in an analytical way by using tools from the mechanical engineering community (screw theory, Grassmann geometry, and Grassmann-Cayley algebra). These tools offer a powerful alternative to the evaluation of the mobility and singularities typically obtained by numerically determining the spectral properties of the bearing rigidity matrix (which typically prevents drawing general conclusions). We apply the proposed machinery to several case formations with different degrees of actuation and discuss known (and unknown) singularity cases for representative formations. The impact on the localization problem is also discussed.