Angle rigidity and its usage to stabilize planar formations

Motivated by the challenging formation stabilization problem for mobile robotic teams when no distance or relative displacement measurements are available and each robot can only measure some of those angles formed by rays towards its neighbors, we develop the notion of ``angle rigidity" for a multi-point framework, named ``angularity", consisting of a set of nodes embedded in a Euclidean space and a set of angle constraints among them. Different from bearings or angles defined with respect to a global axis, the angles we use do not rely on the knowledge of a global coordinate system and are signed according to the counter-clockwise direction. Here \emph{angle rigidity} refers to the property specifying that under proper angle constraints, the angularity can only translate, rotate or scale as a whole when one or more of its nodes are perturbed locally. We first demonstrate that this angle rigidity property, in sharp comparison to bearing rigidity or other reported rigidity related to angles of frameworks in the literature, is \emph{not} a global property since an angle rigid angularity may allow flex ambiguity. We then construct necessary and sufficient conditions for \emph{infinitesimal} angle rigidity by checking the rank of an angularity's rigidity matrix. We develop a combinatorial necessary condition for infinitesimal minimal angle rigidity. Using the developed theories, a formation stabilization algorithm is designed for a robotic team to achieve a globally angle rigid formation, in which only angle measurements are needed.

[1]  Kazunori Sakurama,et al.  Formation shape control with distance and area constraints , 2017, IFAC J. Syst. Control..

[2]  Long Wang,et al.  Angle-based Shape Determination Theory of Planar Graphs with Application to Formation Stabilization , 2018, Autom..

[3]  B. Roth Rigid and Flexible Frameworks , 1981 .

[4]  Patric Jensfelt,et al.  Distributed control of triangular formations with angle-only constraints , 2010, Syst. Control. Lett..

[5]  Shuzhi Sam Ge,et al.  Robust adaptive control of uncertain force/motion constrained nonholonomic mobile manipulators , 2008, Autom..

[6]  P. Hartman Ordinary Differential Equations , 1965 .

[7]  Lihua Xie,et al.  Integrated multi-agent system framework: decentralised search, tasking and tracking , 2015 .

[8]  Camillo J. Taylor,et al.  A vision-based formation control framework , 2002, IEEE Trans. Robotics Autom..

[9]  Seong-Ho Kwon,et al.  Infinitesimal Weak Rigidity and Stability Analysis on Three-Agent Formations , 2018, 2018 57th Annual Conference of the Society of Instrument and Control Engineers of Japan (SICE).

[10]  Walter Whiteley,et al.  Some matroids from discrete applied geometry , 1996 .

[11]  B. Roth,et al.  The rigidity of graphs , 1978 .

[12]  Bruce Hendrickson,et al.  Conditions for Unique Graph Realizations , 1992, SIAM J. Comput..

[13]  Yiguang Hong,et al.  Distributed formation control with relaxed motion requirements , 2015 .

[14]  W. Whiteley,et al.  Generating Isostatic Frameworks , 1985 .

[15]  B. Ildefonse,et al.  Mechanical interactions between rigid particles in a deforming ductile matrix. Analogue experiments in simple shear flow , 1992 .

[16]  B. Roth,et al.  The rigidity of graphs, II , 1979 .

[17]  Seong-Ho Kwon,et al.  Infinitesimal Weak Rigidity, Formation Control of Three Agents, and Extension to 3-dimensional Space , 2018, ArXiv.

[18]  J. Hendrickx,et al.  Rigid graph control architectures for autonomous formations , 2008, IEEE Control Systems.

[19]  Manfredi Maggiore,et al.  Necessary and sufficient graphical conditions for formation control of unicycles , 2005, IEEE Transactions on Automatic Control.

[20]  Hyo-Sung Ahn,et al.  Rigidity of distance-based formations with additional subtended-angle constraints , 2017, 2017 17th International Conference on Control, Automation and Systems (ICCAS).

[21]  Robert Connelly,et al.  Generic Global Rigidity , 2005, Discret. Comput. Geom..

[22]  B. Anderson,et al.  Sensor and network topologies of formations with direction, bearing, and angle information between agents , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[23]  Shiyu Zhao,et al.  Bearing Rigidity Theory and Its Applications for Control and Estimation of Network Systems: Life Beyond Distance Rigidity , 2018, IEEE Control Systems.

[24]  Tolga Eren,et al.  Formation shape control based on bearing rigidity , 2012, Int. J. Control.

[25]  G. Laman On graphs and rigidity of plane skeletal structures , 1970 .

[26]  Shiyu Zhao,et al.  Translational and Scaling Formation Maneuver Control via a Bearing-Based Approach , 2015, IEEE Transactions on Control of Network Systems.

[27]  Mehmet Sarikaya,et al.  Rigid biological composite materials: Structural examples for biomimetic design , 2002 .

[28]  Zhiyong Sun,et al.  Bearing-Based Formation Control of a Group of Agents With Leader-First Follower Structure , 2019, IEEE Transactions on Automatic Control.

[29]  Antonio Franchi,et al.  Bearing rigidity theory in SE(3) , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[30]  Antonio Franchi,et al.  Bearing-only formation control using an SE(2) rigidity theory , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[31]  Andrew G. Sparks,et al.  Spacecraft formation flying: dynamics and control , 1999, Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251).

[32]  J. Hale,et al.  Ordinary Differential Equations , 2019, Fundamentals of Numerical Mathematics for Physicists and Engineers.

[33]  Hyo-Sung Ahn,et al.  A survey of multi-agent formation control , 2015, Autom..

[34]  Shiyu Zhao,et al.  Bearing Rigidity and Almost Global Bearing-Only Formation Stabilization , 2014, IEEE Transactions on Automatic Control.