Rigidity Theory in SE(2) for Unscaled Relative Position Estimation using only Bearing Measurements

Abstract

This work considers the problem of estimating the unscaled relative positions of a multi-robot team in a common reference frame from bearing-only measurements. Each robot has access to a relative bearing measurement taken from the local body frame of the robot, and the robots have no knowledge of a common or inertial reference frame. A corresponding extension of rigidity theory is made for frameworks embedded in the \emph{special Euclidean group} $SE(2)={\mathbb{R}}^2\times {\mathcal{S}}^1$. We introduce definitions describing rigidity for $SE(2)$ frameworks and provide necessary and sufficient conditions for when such a framework is \emph{infinitesimally rigid} in $SE(2)$. Analogous to the rigidity matrix for point formations, we introduce the \emph{directed bearing rigidity matrix} and show that an $SE(2)$ framework is infinitesimally rigid if and only if the rank of this matrix is equal to $2|\mathcal{V}|-4$, where $|\mathcal{V}|$ is the number of agents in the ensemble. The directed bearing rigidity matrix and its properties are then used in the implementation and convergence proof of a distributed estimator to determine the {unscaled}{} relative positions in a common frame. Some simulation results are also given to support the analysis.

submitted to 2014 European Control Conference

References in corpus (1)

• Decentralized Rigidity Maintenance Control with Range Measurements for Multi-Robot Systems

Cited by in corpus (9)

• Bearing Rigidity and Almost Global Bearing-Only Formation Stabilization
• Cooperative Localisation of a GPS-Denied UAV using Direction of Arrival Measurements
• Cooperative Manipulation via Internal Force Regulation: A Rigidity Theory Perspective
• Infinitesimal Weak Rigidity, Formation Control of Three Agents, and Extension to 3-dimensional Space
• Bearing Rigidity Theory and its Applications for Control and Estimation of Network Systems: Life Beyond Distance Rigidity
• Localizability and Distributed Protocols for Bearing-Based Network Localization in Arbitrary Dimensions
• Angle-based Shape Determination Theory of Planar Graphs with Application to Formation Stabilization
• Distributed scaling control of rigid formations
• Translational and Scaling Formation Maneuver Control via a Bearing-Based Approach