Next Article in Journal
A Lexicon-Based Framework for Mining and Analysis of Arabic Comparative Sentences
Previous Article in Journal
AI Algorithms for Positive Change in Digital Futures
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Vertex-Weighted Consensus-Based Formation Control with Area Constraints and Collision Avoidance

by
Ulises Hernandez-Venegas
,
Jesus Hernandez-Barragan
,
Irene Gomez Jimenez
,
Gabriel Martinez-Soltero
* and
Alma Y. Alanis
*
Departamento de Innovación Basada en la Información y el Conocimiento, Centro Universitario de Ciencias Exactas e Ingenierías, Universidad de Guadalajara, Guadalajara 44430, Mexico
*
Authors to whom correspondence should be addressed.
Algorithms 2025, 18(1), 45; https://doi.org/10.3390/a18010045
Submission received: 9 December 2024 / Revised: 27 December 2024 / Accepted: 9 January 2025 / Published: 13 January 2025
(This article belongs to the Section Algorithms for Multidisciplinary Applications)

Abstract

:
In this paper, a consensus-based formation control strategy is presented, subject to area constraints and collision avoidance. To achieve a desired formation pattern, a control law is proposed that incorporates a vertex-tension function along with signed area constraints. The vertex-tension function provides the capabilities of collision avoidance among agents. Moreover, signed area constraints avoid local minimum stagnation and mitigate ambiguities within the formation shape. Additionally, the proposed approach can be implemented considering a group of differential-drive mobile robots in both centralized and decentralized settings. Simulation and real-world experiments are performed to validate the effectiveness of the proposed approach, where the experimental setup includes a multi-robot system composed of Turtlebot3® Waffle Pi robots.

1. Introduction

Formation control is a very well-studied problem due to its potential applications in collaborative and cooperative tasks [1]. Formation control aims to drive a multi-agent system to achieve prescribed patterns. Commonly, formation control is solved as a consensus problem [2,3,4], where the state variables of all agents converge to a common value that defines the centroid of the formation. A remarkable advantage of consensus algorithms is that a consensus agreement is reached even in the presence of delays in communication [5,6]. Moreover, the various problems for consensus formation control have been addressed, like formation control with collision avoidance [7,8,9], formation control with communication delays [10,11], noise tolerance formation control [12], fuzzy formation control with input saturation [13], PID formation control with disturbances [14], and formation control with leader–follower networks [15,16,17].
Since collision among agents can occur during the formation control task, artificial potential field approaches are commonly used to deal with collisions [18,19,20]. Repulsive potential fields are combined with consensus-based formation control to include collision avoidance. However, incorporating repulsive fields does not guarantee system stability in the presence of delays [21].
Edge-weighted consensus-based formation control guarantees collision avoidance among agents [22,23]. These approaches exploit the properties of weighted graphs, allowing the formation to rotate and adapt its shape to avoid collision among robots. However, the desired formation cannot always be preserved due to local minima. Local minima may occur for some particular agent positions, especially when agents are aligned. Moreover, a connection between agents is required to avoid a collision between agents. Then, when more agents are involved in a network, more connections are required to avoid collisions. Thus, to guarantee formation and collision capabilities, fully consensus-based communication is always required. In [6], a virtual relabeling strategy, along with a broadcasting algorithm, is proposed to avoid local minima while ensuring that agents converge to the desired formation. The virtual relabeling strategy assigns a virtual label to each agent. Local minimum stagnation is avoided by modifying agents’ labels following an anti-clockwise order concerning the formation’s center of mass. However, the broadcasting algorithm assigns the appropriate label to an agent based on its own position and the position of all other agents, losing the capability of performing a decentralized formation control. Moreover, some particular initial agents’ positions still provoke local minima stagnation. Additionally, the virtual relabeling strategy required fully consensus-based communication.
In [24,25], formation control is achieved based on a gradient descent control law, which incorporates a signed area term to mitigate ambiguities within the formation. When attempting to attain a specific formation, ambiguities may arise in the absence of sufficient inter-agent connections. In the context of n agents that are not fully connected, multiple formations may exist that meet the desired inter-agent distance criteria [25]. This approach enables formation to remain translation- and rotation-independent. However, the proposed control law does not inherently ensure collision avoidance among agents. Additionally, the methodology in [25] is structured around a hierarchical approach, implying that control strategies employed differ among agents within the information.
In this work, vertex-weighted consensus-based formation control is addressed, where a control law is proposed that incorporates a vertex-tension function along with signed area constraints. Inspired by the edge-tension function from [6], a vertex-tension function is proposed, which maintains the capabilities of collision avoidance among agents. Moreover, inspired by the area constraints from [24,25], a signed triangle area term is considered to avoid local minimum stagnation and mitigate formation ambiguities. Thanks to area constraints, collision among agents is guaranteed even if not performing a fully consensus-based communication. The advantage of this approach is that virtual relabeling and broadcasting algorithms are not required, given the capacity to perform formation control in a completely decentralized manner. Plus, the desired formation pattern is achieved for any initial agent positions. Finally, a multi-robot system composed of four Turtlebot3® (Turtlebot3 is a registered trademark of ROBOTIS Inc., Corona, CA, USA) Waffle Pi systems is considered for real-world experimentation, which is a non-holonomic robot.
The contributions of this paper are summarized below:
  • The proposed signed triangle area term avoids local minimum stagnation and mitigates ambiguities within the formation.
  • The proposed vertex-tension function gives the capabilities of collision avoidance among agents, which is an inconvenience in formation control with distance and area constraints [24,25].
  • The proposed approach does not require virtual relabeling and broadcasting algorithms. Then, formation control can be performed in a completely decentralized manner.
  • The desired formation pattern is achieved for any initial agent positions, which is a drawback of edge-weighted formation [6].
This paper is organized as follows: The next section presents the kinematic model formulation of a non-holonomic differential-drive robot, along with the proposed formation control design. Then, simulation and real-world are presented in Section 3. An analysis of the reported results and future research directions is given in Section 4. Finally, the conclusions are provided in Section 5.

2. Problem Formulation

2.1. Kinematic Model Formulation

Our case study considers a set of N non-holonomic differential-drive robots, which are modeled as unicycle kinematics (1). A differential-drive model is illustrated in Figure 1. For each mobile platform i, the robot pose is given by position ( x i , y i ) and orientation θ i with respect to world frame { F W } . Moreover, a base frame { F B } is attached to middle point of the two wheels, and θ i is measured from ( x i , y i ) pointing to ( x i L , y i L ) relative to the x-axis of the frame { F W } . The point ( x i L , y i L ) is proposed for control purposes to deal with non-holonomic constraints [26]. Parameter L i represents a distance from ( x i , y i ) to ( x i L , y i L ) . Finally, v i and ω i are the linear and angular velocities, respectively.
The unicycle kinematics model is given by
x ˙ i = v i cos ( θ i ) y ˙ i = v i sin ( θ i ) θ ˙ i = ω i .
Non-holonomic constraints make the design of v i and ω i difficult, such as ( x i , y i ) approaching a zero state. For this, we define
x i L = x i + L i cos ( θ i ) y i L = y i + L i sin ( θ i ) ,
where L i 0 . After evaluating (1) in the time derivative of (2), we obtain
x ˙ i L y ˙ i L = cos ( θ i ) L i sin ( θ i ) sin ( θ i ) L i cos ( θ i ) v i ω i .
The following input transformation can be used to drive the robot
v i ω i = cos ( θ i ) L i sin ( θ i ) sin ( θ i ) L i cos ( θ i ) 1 x ˙ i L y ˙ i L ,
where ( x ˙ i L , x ˙ i L ) will be designed for formation control purposes.

2.2. Formation Control Design

Since communication topology among a set of robots can be represented with an undirected graph, some basic graph theory concepts are summarized ahead. An undirected graph with N elements is defined as a pair G = ( V , E ) , where E V × V is the edge set of cardinality M and V = { v i , i = 1 , 2 , , N } stands for the vertex set of cardinality N. An edge E k = ( v i , v j ) represents bidirectional communication between agents i and j, where E k is the k-th edge of G.
Inspired by the edge-tension function proposed in [6], we define a vertex-tension function for every vertex v i V instead of every edge in the graph. The vertex-tension is defined as
V i = j N i α i j coth l i j δ k i j + 1 2 l i j 2 V i j m i n ,
where N i = { v j V ( i , j ) E } is the subset of neighbors of the i-th robot, and K i j is a constant that defines a related position of the minimum of the edge-tension function, i.e., the desired distance for each couple of agents.
Moreover, α i j defines the intensity of the inter-robot influence, δ is a safety distance to avoid collision between agents, and V i j m i n is defined as follows
min l i j > δ V i = 0
Finally, l i j = p i p j is the edge vector between agents i and j, where p i is the state of the i-th agent. In the case of differential-drive robots, the state of the i-th agent is given by
p i = x i L y i L
Inspired by [24,25], we proposed creating a connected graph such that every vertex v i V is part of at least one triplet ( i , j , k ) , where { ( i , j ) , ( j , k ) , ( k , i ) } E (see Figure 2). Every triplet is related to a signed area function that can be useful to avoid ambiguities and local minima.
The set of all triplets ( i , j , k ) in the graph is denoted by C . Notice that if we permute the triplet in a cyclical way, we will be referring to the same triplet, that is, ( i , j , k ) : = ( k , i , j ) : = ( j , k , i ) . Then, we can define the subset C i = { ( j , k ) | ( i , j , k ) C } that denotes all triplets where the vertex v i is involved.
As an example, we can see that the set C for Figure 2a is defined as
C = { ( 0 , 1 , 5 ) , ( 1 , 2 , 3 ) , ( 3 , 4 , 5 ) , ( 1 , 3 , 5 ) } ,
where we have the next subsets
C 0 = { ( 1 , 5 ) } C 1 = { ( 5 , 0 ) , ( 2 , 3 ) , ( 3 , 5 ) } C 5 = { ( 0 , 1 ) , ( 3 , 4 ) , ( 1 , 3 ) } .
We proposed the triplet-tension function for every vertex v i
V C i = ( j , k ) C i 1 2 K C i j k Z i j k Z i j k * 2 ,
where K C i j k R is a constant greater than zero that allows for avoiding ambiguities and local minima. Moreover, Z i j k and Z i j k * are the currently signed area and desired signed area of the triplet ( i , j , k ) , respectively.
The triplet area Z i j k is defined as
Z i j k : = 1 2 det 1 1 1 p i p j p k .
As can be seen in (9), Z i j k = Z k i j = Z j k i because of the switching property of the determinant. Moreover, the triplet could be permuted in a cyclical way.
Based on (5) and (8), a total potential function can be defined as
V = i = 1 N V i + V C i .
The total potential function V in (10) exploits the collision avoidance capacities of (5), plus the match for all the signed areas formed by the triplets (8), which is useful to avoid ambiguities such as a flipped version of the desired formation and local minima. It is a fact that (10), including (8), causes each area to be counted three times since each area is considered in three of the subsets C 0 , C 1 , , C N . In other words, vertex j or k of the triplet in a different iteration could be the value of i, but that is covered with the gain K C i j k > 0 . Actually, if K C i j k were equal to 1 / 3 , the result obtained would be as if each area had only been counted once. What we obtain by doing it this way is unifying the potential energy Equations (5) and (8) in terms of the vertices instead of having one in terms of bonds [6] and another in terms of triplets [24,25]. Using d * = 2 a a = d * / 2 > 0 according to (6), it is possible to ensure the Anderson [24,25] and Falconi [6] convergence and stability conditions at d * = δ , with d * as the desired distance between two defined agents (see Appendix A). Then, the value of d * is calculated according to
d * = l i j
For control purposes, we can use the next gradient descent law
p ˙ i = V p i ,
which can be used as control input for agent i. Then, we have
p ˙ i = U N i + U C i ,
where
U N i = j N i α i j 1 k i j l i j csch 2 l i j δ k i j + 1 l i j ,
U C i = ( j , k ) C i K C i j k Z i j k Z i j k * 0 1 1 0 l j k .
Since control law (13) is only based on agent i and its neighbors’ ( j , k ) positions, it could be implemented as a decentralized control as long as every vertex in the graph is part of at least one triplet. This is very useful because every 2D shape could be represented as a 2D triangulated mesh; this allows us to reduce the number of connections between agents.
The signed area function defined in (9) requires the global positions p i , p j , and p k for control. However, this function can be expressed in terms of the relative position of p j and p k with respect to p i for decentralized control purposes. Then, (9) can be rewritten as
Z i j k = 1 2 l i j T 0 1 1 0 l i k .
The use of a signed area function (16) allows for the control of any number of agents in a decentralized way because we only need the neighbor’s relative position.
Notice that the proposed control law in (13) is designed for holonomic robots. In the case of non-holonomic systems, such as differential-drive mobile platforms, the transformation in (4) can be useful to drive the non-holonomic with ( v i , ω i ) inputs. Then, the agents converge in the position ( x i L , y i L ) rather than ( x i , y i , θ i ) .

3. Experimental Results

The applicability of the proposed approach is validated through simulations and real-world experiments. The performance of the proposed approach is compared against edge-weighted formation control with virtual relabeling [6] in both simulations and real-world experiments. In this work, the compared formation control is called a conventional approach.
In the simulation experiments, a network of six holonomic mobile robots was considered to achieve the formation patterns shown in Figure 2a,b. Moreover, a network of four holonomic mobile robots was considered to achieve the formation pattern shown in Figure 2c. For real-world experimentation, four non-holonomic Turtlebot3® Waffle Pi mobile robots were considered to achieve the formation pattern shown in Figure 2c.
Formation control for non-holonomic mobile robots is achieved by considering the use of coordinate transformations, as defined in (2). Instead of employing the conventional p i = [ x i , y i ] T coordinates, we adopt p i L = [ x i L , y i L ] T and utilize the input transformation outlined in (4).
The k i j and Z i j k * values for the hexagonal, rectangular, and square formation patterns are given in Table 1, Table 2, and Table 3, respectively. The value of k i j is tuned to define the distance between agents p i and p j ; indeed, k i j define the formation patterns. Moreover, Z i j k * is a desired signed area, which can be computed with (9).
With respect to formation control settings, the safety distance was set to δ = 0.2 , the inter-robot influence was fixed to α = 0.7 , and the signed area control gain for all triplets was fixed to K C i j k = 10 . These parameters were experimentally selected.
For simplicity, the physical parameter L i is set to 0.05 meters for all Turtlebot3® systems. Additionally, the linear and angular velocities ( v i , ω i ) are bounded to 0.2 v i 0.2 and 0.9 ω i 0.9 . This saturation is imposed to protect the equipment, but only for real-world implementations.

3.1. Simulation Experiments

In Figure 3, the hexagonal formation results using the conventional approach are reported. We can see how the virtual relabeling algorithm works, which can be beneficial in avoiding local stagnation. However, it is clear that we are not treating every agent as unique since the final formation has no order. Starting from robot 0 in the anti-clockwise direction, we have the robots 3, 1, 5, 4, and 2, which is not the desired order. In contrast, the hexagonal formation results using the proposed approach are reported in Figure 4. In this case, we achieved the same formation without the need for virtual relabeling. The final positions give us the desired order. Here, we have the following robot order—0, 1, 2, 3, 4, and 5—in anti-clockwise direction. As mentioned, the conventional approach suffers from local stagnation for some initial conditions of the robots. The performance of both the conventional and proposed approaches are illustrated in Figure 5 and Figure 6, where the drawback of [conventional approach arose. When starting in a formation where all robots are lined up, the control in the conventional approach only actuates along this line, causing all agents to remain stuck in this region, as depicted in Figure 3b and Figure 4b. In contrast, the proposed approach does not have this local stagnation, thanks to the signed triangle area term. We can see, in Figure 5c and Figure 6c, that the proposed approach achieved the formations depicted in Figure 2b and Figure 2a, respectively.
One of the benefits of adding the desired signed area is that the agents now have more knowledge about the final formation. In the proposed approach, agents need fewer connections to achieve their objective, which is in contrast to the conventional approach in which consensus-based communication is often required, especially in the case of collision avoidance and formation ambiguities. As can be seen in Figure 7, the conventional approach was unable to achieve the final formation, despite all robots being in their correct order, as suggested by the virtual relabeling algorithm. However, the proposed approach successfully achieved the desired formation. Figure 8 shows the square formation results starting from a line and using four non-holonomic robots. The drawbacks of the conventional approach arose due to the robots being initially arranged in a line formation. However, this inconvenience occurs when all of them are oriented in the same direction as the line. In contrast, the proposed approach successfully achieved the desired formation pattern.
Figure 9 shows the formation results of two equilateral triangles using four non-holonomic robots. In this case, the performance of both approaches is compared under situations where ambiguities arise. The formation produced by conventional control meets prescribed edge lengths but deviates from the desired configuration. To realize the desired formation with conventional control, additional inter-agent connections would be needed. For this assessment, we utilized the following formation values: k 01 = k 02 = k 12 = k 13 = k 23 = 0.852 and z 012 = z 132 = 0.433 .

3.2. Real-World Experiments

In real-world experimentation, four Turtlebot3® Waffle Pi robots are considered. The Turtlebot3® Waffle Pi is an ROS-based differential-drive mobile robot used for education, research, and product development applications [27] (see Figure 10). The ROS (ROS is a registered trademark of Open Robotics, Mountain View, CA, USA) packages of Turtlebot3® provide access to send velocity control inputs and read its odometry.
In this section, we perform two experiments, which we call Experiment 1 and Experiment 2. In Experiment 1, we will address the initial line position to achieve the square formation depicted in Figure 2c with the values listed in Table 3. In Experiment 2, we will tackle a specific ambiguity case where the desired formation is two equilateral triangles. Thus, the formation patterns are defined as k 01 = k 02 = k 12 = k 13 = k 23 = 0.852 , and the desired signed areas are Z 012 * = Z 132 * = 0.433 .
In the case of Experiment 1, Figure 11 illustrates the performance of the conventional approach without virtual relabeling. We have intentionally omitted the use of a virtual relabeling algorithm to highlight its significance within this control law. To assess the performance of the proposed approach, please refer to Figure 12. It is reported that the line starting position does not pose a challenge for the proposed approach, regardless of whether it is applied to holonomic or non-holonomic robots. The achieved formation patterns are depicted in Figure 11b and Figure 12b.
In the case of Experiment 2, Figure 13 reports the performance of the conventional approach with virtual relabeling under the presence of ambiguities. Moreover, the performance of the proposed approach is illustrated in Figure 14. Notably, even with the use of the virtual relabeling algorithm, the conventional approach fails to attain the desired formation pattern, in stark contrast to the proposed approach, which correctly achieves the desired formation. The incorporation of the signed area term allows for achieving the desired formation pattern, even in the presence of ambiguities.

4. Discussion

Based on the obtained results, we have verified that the proposed control law (13) preserves the advantages of the formation control law outlined in [6]. These advantages include rotational and translation independence, as well as collision avoidance among connected agents. Notably, the proposed approach does not rely on the virtual relabeling algorithm or broadcasting process.
The proposed approach consistently achieves the desired formation under various conditions, regardless of the initial state, as evidenced by Figure 5, Figure 6, Figure 8, and Figure 9. This achievement sets it apart from the conventional approach. In Experiment 1, we can see that, in real-world applications, the conventional approach drives the robots out of the line formation after a few seconds. This is mainly due to a range of factors, including errors in odometry, signal noise, and surface conditions. In such scenarios, our dependence on these factors becomes essential to attaining the desired formation. Consequently, there is a continuous need for the application of the virtual relabeling algorithm because, in the initial moments, it is not possible to ascertain correct virtual labels until the line formation is disrupted. Regrettably, this ongoing process can lead to increased latency in network communication.
Moreover, the proposed approach effectively handles ambiguities in the formation control problem without necessitating additional connections between agents, as illustrated in Figure 7. This is in contrast to the conventional approach, which would require the creation of a connection between agent 1 and agent 4 to resolve the ambiguity, similar to Experiment 2.
By utilizing (8), our proposed approach operates in a fully decentralized manner, relying only on the relative positions of neighboring agents. It also accurately recognizes the role of each agent within the formation. For example, if the goal is to arrange all robots in a counter-clockwise direction, the proposed approach can achieve it, a feat not possible with the conventional approach for certain initial conditions, as demonstrated in Figure 3 and Figure 4.
The simulations and real-world experiments showed that the robots successfully achieved the desired formation with smooth trajectories. However, the input control signals in real-world implementations exhibited some noise, primarily due to non-modeled dynamics, packet loss, actuator limitations, and other real-world factors.
This work predominantly centers on the realm of 2D planes featuring differential mobile robots. For future endeavors, analogous concepts can be explored in the domain of 3D space, specifically with aerial robots or similar platforms. In this scenario, the study would incorporate the notion of the signed volume of a tetrahedron comprising four vertices. Consequently, a minimum of four connected agents would be essential to establish volumetric formations.

5. Conclusions

This paper delves into the xy-plane formation problem, aiming to create formations with a minimum of three agents. The results show that incorporating the signed area term, coupled with collision avoidance control, consistently enables us to achieve the desired formations under various conditions.
The incorporation of the signed area in the control law allows us to address the formation problem with fewer connections, a crucial advantage when dealing with substantial distances between agents. This is illustrated in Figure 7, where, as previously discussed, the compared formation control method would necessitate a connection between agent one and agent four. However, this link would be the longest in the formation, and in real-world scenarios, measuring such a distance might be impractical.
Regardless of the initial agent’s positions, the proposal shows that local minima stagnation is avoided using area constraints based on triplets, a drawback of conventional edge-weighted consensus-based formation control. Moreover, the proposal avoids collision among agents thanks to the vertex-tension function, which is not considered in conventional formation control with distance and area constraints.
The proposed approach requires providing formation patterns based on triples. Then, the minimum number of agents to consider in a formation problem is three. However, defining triplets in a network of a bunch of agents can take time and effort. The signed area can be extended to use other geometric figures, such as squares, pentagons, and hexagons, to easily represent connection among agents.
The proposed control approach offers a decentralized solution to the formation problem, applying the same control law for all agents without requiring knowledge of the full network, in contrast to the conventional control method with the virtual relabeling algorithm. This characteristic facilitates easier implementation in real-world experiments.
Looking ahead, our proposed control approach can be extended to the xyz-space, utilizing the concept of the signed volume of a tetrahedron. In this context, the analysis should focus on quartets rather than triplets.

Author Contributions

Conceptualization, U.H.-V. and J.H.-B.; data curation, A.Y.A. and U.H.-V.; funding acquisition, A.Y.A., J.H.-B., I.G.J. and G.M.-S.; investigation, U.H.-V. and J.H.-B.; methodology, U.H.-V. and J.H.-B.; project administration, A.Y.A., I.G.J. and G.M.-S.; software, U.H.-V. and J.H.-B.; validation, A.Y.A., U.H.-V. and J.H.-B.; visualization, A.Y.A., U.H.-V. and J.H.-B.; writing—original draft, A.Y.A., U.H.-V. and J.H.-B.; writing—review and editing, I.G.J. and G.M.-S. All authors have read and agreed to the published version of the manuscript.

Funding

This research was funded by CONAHCYT Mexico through Project PCC-2022-319619.

Data Availability Statement

The data analyzed are available from the authors upon request.

Acknowledgments

The authors also thank Universidad de Guadalajara for their support in this research.

Conflicts of Interest

The authors declare no conflicts of interest.

Abbreviations

The following abbreviations are used in this manuscript:
ROSRobot operating system

Appendix A

In Section 2.2, it is stated that total potential function V, defined in (10), has its minimum value at d * = δ , according to Anderson [24,25] and Falconi [6] conditions; for condition established by Falconi [6] it is clear that (6) must be satisfied. However, according to the Anderson [24,25] condition, it is required to develop an adequate condition to find the minimum value for (8). Such a condition is obtained in this Appendix. Let us consider (6) and Z i j k * as the designed area, as in (8). These specifications describe a formation that is unique in translation and rotation, but they exclude any ambiguity by inversion. Until this point, the selection of an equilateral triangle is performed for illustrative purposes; however, analytic results can be obtained. Assume a formation system that consists of three agents: i , j , k . Furthermore, agents i , j are fixed such that p i p j   = d * . Also, suppose that agent k is ruled by (12), where d i j * = d j k * = d k i * = d * , and the potential function V i j k is defined as (8); then, without loss of generality, if K > 3 / 2 , p k globally converges to the only correct equilibrium point defined as
p * = 0 3 a
for
p i = a 0 , p j = a 0 , p k = x y
where a : = d * / 2 > 0 ; therefore,
p k * = 1 2 K ( Z i j k Z i j k * ) 0 1 1 0 l i j
where
Z i j k = a y Z i j k * = 3 a 2
The stability of robot formation with potential field-based control law has been studied by several researchers in different ways [28,29,30,31,32]. To avoid unnecessary mathematical complication, in this work, we consider the analysis developed in [33], where dynamic equivalence is established between a Lyapunov function and a potential function. Therefore, according to the proposed analysis for the potential function, it is possible to establish that agents reach the desired geometric pattern once condition (11) is achieved. For a detailed stability analysis, we refer the reader to the following related papers [28,29,30,31,32]; in all of them, the authors encounter a direct relationship between the defined potential function and the Lyapunov function, which can be designed based on such a potential function. Then, for the scope of this work, as in [6,25], we establish stability conditions to reach a desired final configuration, defining each desired robot position as an equilibrium point. Then, all trajectories will converge to the correct formation, as reported in [6,25], once condition (11) is ensured for potential function (10).

References

  1. Oh, K.K.; Park, M.C.; Ahn, H.S. A survey of multi-agent formation control. Automatica 2015, 53, 424–440. [Google Scholar] [CrossRef]
  2. Gong, X.; Liu, J.J.; Wang, Y.; Cui, Y. Distributed finite-time bipartite consensus of multi-agent systems on directed graphs: Theory and experiment in nano-quadcopters formation. J. Frankl. Inst. 2020, 357, 11953–11973. [Google Scholar] [CrossRef]
  3. Xiong, T.; Pu, Z.; Yi, J.; Tao, X. Consensus Based Formation Control for Multi-UAV Systems with Time-varying Delays and Jointly Connected Topologies. In Proceedings of the 2018 IEEE 14th International Conference on Automation Science and Engineering (CASE), Munich, Germany, 20–24 August 2018; pp. 292–297. [Google Scholar] [CrossRef]
  4. Zhou, Y.; Liu, Y.; Zhao, Y. Prescribed-time Bipartite Consensus Formation Control for General Linear Multi-agent Systems. In Proceedings of the IECON 2020 The 46th Annual Conference of the IEEE Industrial Electronics Society, Singapore, 19–21 October 2020; pp. 3562–3567. [Google Scholar]
  5. Fax, J.; Murray, R. Information flow and cooperative control of vehicle formations. IEEE Trans. Autom. Control 2004, 49, 1465–1476. [Google Scholar] [CrossRef]
  6. Falconi, R.; Sabattini, L.; Secchi, C.; Fantuzzi, C.; Melchiorri, C. Edge-weighted consensus-based formation control strategy with collision avoidance. Robotica 2015, 33, 332–347. [Google Scholar] [CrossRef]
  7. Liu, Y.; Yu, H.; Shi, P.; Lim, C.C. Formation control and collision avoidance for a class of multi-agent systems. J. Frankl. Inst. 2019, 356, 5395–5420. [Google Scholar] [CrossRef]
  8. Cong, Y.; Du, H.; Jin, Q.; Zhu, W.; Lin, X. Formation control for multiquadrotor aircraft: Connectivity preserving and collision avoidance. Int. J. Robust Nonlinear Control 2020, 30, 2352–2366. [Google Scholar] [CrossRef]
  9. Hu, J.; Zhang, H.; Liu, L.; Zhu, X.; Zhao, C.; Pan, Q. Convergent Multiagent Formation Control With Collision Avoidance. IEEE Trans. Robot. 2020, 36, 1805–1818. [Google Scholar] [CrossRef]
  10. Nuño, E.; Loría, A.; Hernández, T.; Maghenem, M.; Panteley, E. Distributed consensus-formation of force-controlled nonholonomic robots with time-varying delays. Automatica 2020, 120, 109114. [Google Scholar] [CrossRef]
  11. Maghenem, M.; Loría, A.; Nuño, E.; Panteley, E. Consensus-Based Formation Control of Networked Nonholonomic Vehicles With Delayed Communications. IEEE Trans. Autom. Control 2021, 66, 2242–2249. [Google Scholar] [CrossRef]
  12. Wang, C.; He, P.; Li, H.; Tian, J.; Wang, K.; Li, Y. Noise-tolerance consensus formation control for multi-robotic networks. Trans. Inst. Meas. Control 2020, 42, 1569–1581. [Google Scholar] [CrossRef]
  13. Van, M.; Sun, Y.; Mcllvanna, S.; Nguyen, M.N.; Zocco, F.; Liu, Z.; Wang, H.C. Distributed Fixed-Time Consensus Control for Multiple AUV Systems with Input Saturations. arXiv 2023, arXiv:2302.14162. [Google Scholar]
  14. Romero, J.G.; Nuño, E.; Aldana, C.I. Robust PID consensus-based formation control of nonholonomic mobile robots affected by disturbances. Int. J. Control 2023, 96, 791–799. [Google Scholar] [CrossRef]
  15. Yu, H.; Shi, P.; Lim, C.C.; Wang, D. Formation control for multi-robot systems with collision avoidance. Int. J. Control 2019, 92, 2223–2234. [Google Scholar] [CrossRef]
  16. Shi, Q.; Li, T.; Li, J.; Chen, C.P.; Xiao, Y.; Shan, Q. Adaptive leader-following formation control with collision avoidance for a class of second-order nonlinear multi-agent systems. Neurocomputing 2019, 350, 282–290. [Google Scholar] [CrossRef]
  17. Sui, Z.; Pu, Z.; Yi, J.; Wu, S. Formation Control With Collision Avoidance Through Deep Reinforcement Learning Using Model-Guided Demonstration. IEEE Trans. Neural Networks Learn. Syst. 2021, 32, 2358–2372. [Google Scholar] [CrossRef] [PubMed]
  18. Pang, Z.H.; Zheng, C.B.; Sun, J.; Han, Q.L.; Liu, G.P. Distance- and Velocity-Based Collision Avoidance for Time-Varying Formation Control of Second-Order Multi-Agent Systems. IEEE Trans. Circuits Syst. II Express Briefs 2021, 68, 1253–1257. [Google Scholar] [CrossRef]
  19. Hu, J.; Wang, M.; Zhao, C.; Pan, Q.; Du, C. Formation control and collision avoidance for multi-UAV systems based on Voronoi partition. Sci. China Technol. Sci. 2020, 63, 65–72. [Google Scholar] [CrossRef]
  20. Xia, G.; Zhang, Y.; Yang, Y. Control Method of Multi-AUV Circular Formation Combining Consensus Theory and Artificial Potential Field Method. In Proceedings of the 2020 Chinese Control And Decision Conference (CCDC), Hefei, China, 22–24 August 2020; pp. 3055–3061. [Google Scholar] [CrossRef]
  21. Secchi, C.; Fantuzzi, C. Formation control over delayed communication networks. In Proceedings of the 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, USA, 19–23 May 2008; pp. 563–568. [Google Scholar] [CrossRef]
  22. Falconi, R.; Gowal, S.; Martinoli, A. Graph based distributed control of non-holonomic vehicles endowed with local positioning information engaged in escorting missions. In Proceedings of the 2010 IEEE International Conference on Robotics and Automation, Anchorage, AK, USA, 3–7 May 2010; pp. 3207–3214. [Google Scholar]
  23. Falconi, R.; Sabattini, L.; Secchi, C.; Fantuzzi, C.; Melchiorri, C. A graph–based collision–free distributed formation control strategy. IFAC Proc. Vol. 2011, 44, 6011–6016. [Google Scholar] [CrossRef]
  24. Anderson, B.D.; Sun, Z.; Sugie, T.; Azuma, S.i.; Sakurama, K. Formation shape control with distance and area constraints. IFAC J. Syst. Control 2017, 1, 2–12. [Google Scholar] [CrossRef]
  25. Sugie, T.; Anderson, B.D.; Sun, Z.; Dong, H. On a hierarchical control strategy for multi-agent formation without reflection. In Proceedings of the 2018 IEEE Conference on Decision and Control (CDC), Miami Beach, FL, USA, 17–19 December 2018; pp. 2023–2028. [Google Scholar]
  26. Siciliano, B.; Sciavicco, L.; Villani, L.; Oriolo, G. Force Control; Springer: Berlin/Heidelberg, Germany, 2009. [Google Scholar]
  27. Amsters, R.; Slaets, P. Turtlebot 3 as a robotics education platform. In Robotics in Education: Current Research and Innovations 10; Springer: Berlin/Heidelberg, Germany, 2020; pp. 170–181. [Google Scholar]
  28. Tanner, H.G.; Kumar, A. Formation stabilization of multiple agents using decentralized navigation functions. In Proceedings of the Robotics: Science and Systems, Cambridge, MA, USA, 8–11 June 2005; Volume 1, pp. 49–56. [Google Scholar]
  29. Ferreira Vázquez, E.D.; Hernández Martínez, E.G.; Flores Godoy, J.J. Formation control of multiple robots avoiding local minima. In Proceedings of the CLCA 2014, Cancun, Mexico, 14–17 October 2014. [Google Scholar]
  30. Dang, A.D.; La, H.M.; Nguyen, T.; Horn, J. Formation control for autonomous robots with collision and obstacle avoidance using a rotational and repulsive force–based approach. Int. J. Adv. Robot. Syst. 2019, 16, 1729881419847897. [Google Scholar] [CrossRef]
  31. Martinez, J.B.; Becerra, H.M.; Gomez-Gutierrez, D. Formation tracking control and obstacle avoidance of unicycle-type robots guaranteeing continuous velocities. Sensors 2021, 21, 4374. [Google Scholar] [CrossRef]
  32. Aranda-Bricaire, E.; González-Sierra, J. Formation with non-collision control strategies for second-order multi-agent systems. Entropy 2023, 25, 904. [Google Scholar] [CrossRef] [PubMed]
  33. Yuan, R.S.; Ma, Y.A.; Yuan, B.; Ao, P. Lyapunov function as potential function: A dynamical equivalence. Chin. Phys. B 2013, 23, 010505. [Google Scholar] [CrossRef]
Figure 1. Differential-drive robot model.
Figure 1. Differential-drive robot model.
Algorithms 18 00045 g001
Figure 2. Formation patterns for experiments. The desired edge lengths in the formation are defined with the k i j values, and the desired signed area terms are defined with the Z i j k * values. (a) Hexagonal formation with six agents. (b) Rectangular formation with six agents. (c) Square formation with four agents.
Figure 2. Formation patterns for experiments. The desired edge lengths in the formation are defined with the k i j values, and the desired signed area terms are defined with the Z i j k * values. (a) Hexagonal formation with six agents. (b) Rectangular formation with six agents. (c) Square formation with four agents.
Algorithms 18 00045 g002
Figure 3. Hexagonal formation results using the conventional approach with the virtual labeling algorithm. The ★ indicates the start position and ● the final position. (a) Starting positions. (b) Connections after virtual relabeling. (c) Achieved formation pattern.
Figure 3. Hexagonal formation results using the conventional approach with the virtual labeling algorithm. The ★ indicates the start position and ● the final position. (a) Starting positions. (b) Connections after virtual relabeling. (c) Achieved formation pattern.
Algorithms 18 00045 g003
Figure 4. Hexagonal formation results using the proposed approach. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern.
Figure 4. Hexagonal formation results using the proposed approach. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern.
Algorithms 18 00045 g004
Figure 5. Rectangular formation results starting from a diagonal. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Figure 5. Rectangular formation results starting from a diagonal. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Algorithms 18 00045 g005
Figure 6. Hexagonal formation results starting from a line. The ★ indicates the start position, and ● denotes the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Figure 6. Hexagonal formation results starting from a line. The ★ indicates the start position, and ● denotes the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Algorithms 18 00045 g006
Figure 7. Hexagonal formation results starting from a rectangular one. The ★ indicates the start position, and ● marks the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Figure 7. Hexagonal formation results starting from a rectangular one. The ★ indicates the start position, and ● marks the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Algorithms 18 00045 g007
Figure 8. Square formation results starting from a line and using four non-holonomic robots. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Figure 8. Square formation results starting from a line and using four non-holonomic robots. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Algorithms 18 00045 g008
Figure 9. Square formation results of two equilateral triangles and using four non-holonomic robots. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Figure 9. Square formation results of two equilateral triangles and using four non-holonomic robots. The ★ indicates the start position, and ● represents the final position. (a) Starting positions. (b) Achieved formation pattern using the conventional approach. (c) Achieved formation pattern using the proposed approach.
Algorithms 18 00045 g009
Figure 10. Turtlebot3® Waffle Pi.
Figure 10. Turtlebot3® Waffle Pi.
Algorithms 18 00045 g010
Figure 11. Formation control results of the conventional approach for Experiment 1. The ★ indicates the start position, and ● represents the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Figure 11. Formation control results of the conventional approach for Experiment 1. The ★ indicates the start position, and ● represents the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Algorithms 18 00045 g011aAlgorithms 18 00045 g011b
Figure 12. Formation control results of the proposed approach for Experiment 1. The ★ indicates the start position, and ● represents the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Figure 12. Formation control results of the proposed approach for Experiment 1. The ★ indicates the start position, and ● represents the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Algorithms 18 00045 g012
Figure 13. Formation control results of the conventional approach for Experiment 2. The ★ indicates the start position, and ● marks the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Figure 13. Formation control results of the conventional approach for Experiment 2. The ★ indicates the start position, and ● marks the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Algorithms 18 00045 g013
Figure 14. Formation control results of the proposed approach for Experiment 2. The ★ indicates the start position, and ● represents the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Figure 14. Formation control results of the proposed approach for Experiment 2. The ★ indicates the start position, and ● represents the final position. (a) Achieved formation pattern with trajectories. (b) Achieved formation pattern with Turtlebot3® robots. (c) Linear velocity of each robot. (d) Angular velocities of each robot.
Algorithms 18 00045 g014
Table 1. Values used for the hexagonal formation.
Table 1. Values used for the hexagonal formation.
k 01 , k 12 , k 34 , k 45 k 13 , k 15 k 05 , k 23 k 35
0.1123 0.4858 0.1493 0.4764
Z 015 * Z 123 * Z 135 * Z 345 *
0.1 0.1 0.28 0.08
Table 2. Values used for the rectangular formation.
Table 2. Values used for the rectangular formation.
k 01 , k 12 , k 34 , k 45 k 05 , k 14 , k 23 k 04 , k 13 Z 014 * , Z 045 * , Z 123 * , Z 134 *
0.08322 0.0832 0.2027 0.08
Table 3. Values used for the square formation.
Table 3. Values used for the square formation.
k 01 , k 12 , k 23 , k 03 k 02 Z 012 * , Z 023 *
0.8517 2.2881 0.5
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Hernandez-Venegas, U.; Hernandez-Barragan, J.; Gomez Jimenez, I.; Martinez-Soltero, G.; Alanis, A.Y. Vertex-Weighted Consensus-Based Formation Control with Area Constraints and Collision Avoidance. Algorithms 2025, 18, 45. https://doi.org/10.3390/a18010045

AMA Style

Hernandez-Venegas U, Hernandez-Barragan J, Gomez Jimenez I, Martinez-Soltero G, Alanis AY. Vertex-Weighted Consensus-Based Formation Control with Area Constraints and Collision Avoidance. Algorithms. 2025; 18(1):45. https://doi.org/10.3390/a18010045

Chicago/Turabian Style

Hernandez-Venegas, Ulises, Jesus Hernandez-Barragan, Irene Gomez Jimenez, Gabriel Martinez-Soltero, and Alma Y. Alanis. 2025. "Vertex-Weighted Consensus-Based Formation Control with Area Constraints and Collision Avoidance" Algorithms 18, no. 1: 45. https://doi.org/10.3390/a18010045

APA Style

Hernandez-Venegas, U., Hernandez-Barragan, J., Gomez Jimenez, I., Martinez-Soltero, G., & Alanis, A. Y. (2025). Vertex-Weighted Consensus-Based Formation Control with Area Constraints and Collision Avoidance. Algorithms, 18(1), 45. https://doi.org/10.3390/a18010045

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop