Abstract
This paper addresses the formation control problem without collisions for multiagent systems. A general solution is proposed for the case of any number of agents moving on a plane subject to communication graph composed of cyclic paths. The control law is designed attending separately the convergence to the desired formation and the noncollision problems. First, a normalized version of the directed cyclic pursuit algorithm is proposed. After this, the algorithm is generalized to a more general class of topologies, including all the balanced formation graphs. Once the finite-time convergence problem is solved we focus on the noncollision complementary requirement adding a repulsive vector field to the previous control law. The repulsive vector fields display an unstable focus structure suitably scaled and centered at the position of the rest of agents in a certain radius. The proposed control law ensures that the agents reach the desired geometric pattern in finite time and that they stay at a distance greater than or equal to some prescribed lower bound for all times. Moreover, the closed-loop system does not exhibit undesired equilibria. Numerical simulations and real-time experiments illustrate the good performance of the proposed solution.
1. Introduction
During the last years, formation control in multiagent systems has received much attention due to the wide range of applications in which they can be used as exploration, rescue tasks, toxic residues cleaning, and so forth, [1, 2]. A very important issue in formation control is the collision avoidance problem, with either other agents or obstacles [3]. If the formation control algorithms are designed in a totally centralized way, that is, with information exchange among all the agents, the computational load can increase seriously. On the other hand, an additional constraint arises if the communication among agents is restricted. Then, in most cases it is assumed that every agent in the group knows for all time the state or simply the position of a specific subset of robots and, eventually, can sense the position of any robot within a certain radius, [4]. Taking into account this difficulty several types of communications, as cyclic or balanced formations graphs, have been studied, [5–8].
Initially, the proposed solutions to the noncollision problem were designed as the sum of attractive and repulsive vector fields, in most cases obtained as the negative gradient of potential functions. Attractive potential functions are centred, for each agent, at its desired position, while the repulsive potential functions are centred at the positions of the rest of agents or even at obstacles’ positions, [9, 10]. Under this approach, one main drawback is the fact that the combination of gradients of attractive and repulsive potential functions could result in the appearance of undesired equilibrium points, leading the agents to get stuck at an undesired formation. Attending this problem, a solution has been proposed with the requirement of having totally centralized schemes [11]. Moreover, the repulsive vector fields are designed in such a way that they appear smoothly as the distance between any pair of agents becomes smaller and tends to infinity when this distance tends to zero. Then, although the collision avoidance is ensured, the position among agents can be arbitrarily small, which could imply a collision in real applications where physical dimensions cannot be ignored.
Related works can be found in [12] where authors consider formation control problems under limited and intermittent sensing. Based on a navigation function framework, a decentralized hybrid controller is developed to ensure network connectivity and collision avoidance while controlling the formation. In [13] the differential game approach is used for a group of agents to reach desired target positions while avoiding collisions among them. A methodical approach to the problem of collision avoidance of mobile robots taking advantages of multiagent systems has been presented in [14]. In order to achieve the trajectory, a control strategy based on a pure pursuit algorithm was implemented in the robots. The collision avoidance in the leader-follower multiagent systems was studied in [15]. The graph theory is used to model the communication topology between agents. To avoid collisions between neighboring agents, a fuzzy separation controller is proposed.
In a recent work, a new strategy for designing the repulsive vector fields has been proposed [16]. This approach differs from the classical one on the use of scaled unstable focus structures centred at the position of others agents. These functions cannot be obtained as the gradient of a scalar function of the distance between agents. Although this technique can also lead to undesired equilibria, these can be removed. The key point is to use an unstable focus scaled by a function depending on the distance among agents. This scaling function vanishes when the agents are far enough and tend to infinity as distance tends to zero. The analysis in [16] has been presented for the case of two agents only, while in [5] an extension to an arbitrary number of agents has been presented for the case of a directed cyclic pursuit communication graph.
In this paper we study the noncollision problem in formation control using discontinuous vector fields for an arbitrary number of agents. In one hand we undertake the design of attractive vector fields based on the well known cyclic pursuit algorithm but, unlike the results reported in the literature [7], we focus our analysis on normalized vector fields. That is, regarding only the attractive part, the agents move at constant known velocity and they reach the desired formation in finite time. Moreover, the case of more general communication graphs is analysed as the combination of single cyclic pursuit schemes. On the other hand, the repulsive vector fields have the unstable focus structure scaled by a suitable constant. As mentioned before, the general problem of an arbitrary number of robots is treated and the designed controllers are proven to be effective from the case where no collision risk exists to the one when a robot is rounded by a set of robots and there could be collision with any of them. It will be shown in this paper that this is the most complex situation that can occur.
This paper is organized as follows. We start in Section 2 stating some useful definitions and technical preliminaries. After this, in Section 3 we present the problem statement along with a couple of standing assumptions. The main contribution is given in Section 4, initially regarding the finite time convergence problem. Then, we take into account all the possible scenarios of collisions, starting with the simplest case of two robots in danger of collision. Based on this simple case we extend the study to risk of multiple collisions. Numerical simulations and real-time experiments are presented in Sections 5 and 6, respectively. Finally, in Section 7, we list the conclusions and outlooks of this research.
2. Preliminaries
As we mentioned before, in this section we state some useful definitions [17, 18] and a technical lemma that we will use in the rest of the paper.
Definition 1 (formation graph). A formation graph that describes the communication among the agents consists of a set of vertices corresponding to each of the agents in the group and a set of edges , which denotes the agent receives information about . Finally, a set of constant vectors that represent the relative desired position of agent with respect to .
For a directed communication graph, implies that . For an undirected formation graph implies that .
Definition 2 (paths and cycles). There exists a path between the vertices and in the formation graph if there is a sequence of edges for some . We call a “cycle” to some path that starts and finishes in the same vertex.
If there is a path between any two vertices of the formation graph, then the graph is called connected. If a formation graph is connected and the vector satisfies the so-called closed-formation condition [19], that is, , then the formation control problem is solvable and the formation graph is said to be well-defined.
Definition 3 (Laplacian matrix). The Laplacian matrix associated with a formation graph is given by where is the degree matrix defined as , where is the number of edges directed to , , and is the adjacency matrix of defined as follows:
Proposition 4. Consider the dynamical system , where and the matrix is Hurwitz. Then the normalized system with is stable with finite time convergence.
Proof. Since is Hurwitz, then, for every matrix there exists a matrix such that the Lyapunov equation holds and is a Lyapunov function for the system . Taking as a Lyapunov function candidate and evaluating the time derivative along the trajectories of the normalized system we haveNote that, since is diagonal, it follows that and , where ; thereforeMoreover, since the matrix is Hurwitz, the Lyapunov equation always admits a positive definite solution for every positive definite matrix . Taking the time derivative is bounded from above by Now, since is diagonal, we haveOn the other hand, knowing that it is true that which implies directly thatThen, is bounded as follows: If we regard the quadratic form as a norm for vector , we can write where is a proportionality constant. This leads to finally write the last expression as that, according to [20], ensures convergence in finite time.
3. Problem Statement
Consider a group of mobile agents denoted by moving on a plane. The cartesian coordinates of agent are given by , . Every robot is described by the kinematic modelwhere are the velocities along the - and -axes. In this paper we consider a decentralized general scheme. We assume that robot can detect the position of a subset of robots , where , . Therefore, the desired position of robot , say , with respect to is defined bywhere is the cardinality of and , . Throughout the paper, the following assumptions are supposed to hold.
Assumption 5. Agent measures the position of agents for all time and, eventually, can detect the presence of any other agent within a circle of radius . More precisely, can detect the agents in the set .
Assumption 6. The initial conditions of all agents satisfy , .
3.1. Control Goal
The goal is to design control laws , , such that(i)the agents reach a desired formation; that is, ;(ii)there are no collisions among agents; moreover, at all times robots remain at some distance greater than or equal to a predefined distance from each other; that is, , , .
4. Control Design
The control design is presented in two parts, one of each attending a different objective according to the control goal. We start proposing a control law based on normalized attractive vector fields to ensure finite time convergence of the agents to the desired formation.
4.1. Attractive Vector Fields
The control law to reach the desired formation pattern is designed based on attractive vector fields proportional to the position error; that is,where corresponds to the position errors and is a design parameter. In this paper, we consider a normalized version of (15) to treat a suitable system where all the agents move at the same known velocity; namely,where is the constant velocity of all agents. In real time experiments, the control law (16) can induce chattering effects which can be avoided as it is shown in Section 6. Now, we can state our first main result regarding a cyclic pursuit directed communication graph, as shown in Figure 1(a), which is the basement for further cases.
(a)
(b)
Theorem 7. Consider system (13) and the control law (16). Also assume a formation graph with directed cyclic pursuit topology (Figure 1(a)). Then, in the closed-loop system (13)–(16) the mobile robots converge to the desired formation in finite time.
Proof. Consider the error coordinates , . For the closed-loop system (13)–(16) the error dynamics is given byOr, in matrix form, it is given bywhere is the Laplacian matrix of the communication graph in Figure 1(a), is the constant velocity of agents, denotes the Kronecker product, and is the identity matrix. This yields to writewhereTherefore, the closed-loop system has the same form as but is affected by the normalization as the system in the Proposition 4; then it is enough to show that in the system without normalization the agents converge asymptotically to the desired formation to ensure finite time convergence for the closed-loop system (13)–(16). According to [11], the Laplacian matrix of a connected formation graph has a single zero eigenvalue, , associated with the vector , while the rest of them satisfy . As it was assumed, the closed formation condition holds, which directly implies . Then, is it possible to analyse a subsystem formed by the first error coordinates knowing that . For the specific case of a cyclic pursuit directed formation graph the Laplacian matrix has the formthen, the reduced system is given bywhere and is the resulting matrix for the reduced system.
Then, the stability of the system is simplified to the analysis of the matrixIn order to verify that we compute the determinant of the first principal minors. Denote by the determinant of the principal minor of dimension . Therefore, for the first cases it is clear that because all of them are upper diagonal matrices. To check that we develop by the last column in an iterative way This ensures all the eigenvalues of have strictly positive real parts, and this implies the reduced system is asymptotically stable, that is, as , and because of the relation , it is clear that also as . Then, in the whole system agents converge asymptotically to the desired formation, and even more, by direct application of Proposition 4, for the closed-loop system (13)–(16), the agents reach the desired formation in finite time. This concludes the proof.
In the last proof, the closed formation condition was useful in order to reduce the original system. In the same way, we can state a corollary to show the stability for the case of an undirected cyclic pursuit formation graph.
Corollary 8. Consider the closed-loop system (13)–(16) using an undirected communication graph (Figure 1(b)). Then, the agents converge to the desired formation in finite time.
Proof. The closed-loop system in terms of the Laplacian matrix and using initially (15) instead of (16) takes the formwhich in terms of the Laplacian matrix can be written aswhere the Laplacian matrix of an undirected cyclic pursuit formation graph isNow, if we consider the undirected graph as a combination of two directed graphs, we havewhere the Laplacian corresponds to the directed (clockwise) original graph, while corresponds to the opposite direction (counter-clockwise) formation graph. Both Laplacian matrices and satisfy the closed-formation condition. This means that , where and are the error variables defined for the formation described for and , respectively. Combining these conditions we havewhich by simplifying becomeswhere are the error variables for the composed Laplacian . As before, knowing that the Laplacian matrix of a connected communication graph has a single zero eigenvalue, , while the rest of them satisfy . Using the relationship the analysis can be reduced again to the first error variables, in such a way thatis asymptotically stable, with defined as above. This implies, again, as which also means as . As a result, the closed-loop system is asymptotically stable, which ensures in the closed-loop system (13)–(16) by application of Proposition 4, the agents reach the desired formation in finite time.
Example 9. To cover a more general class of communication graphs, let us consider as an example the graphic shown in Figure 2. This communication graph can be described entirely as the superposition of two directed cyclic pursuit communication subgraphs, that is, the combination of the cyclic paths and . The errors for the closed-loop system are given in matrix form, bywhich can be written in terms of the Laplacian matrix aswith defined as in Section 2. Since the analysis is reduced to the properties of . For this particular example we havewhile the Laplacian matrices corresponding to the subgraphs and areAs the Laplacian matrices for each cyclic path satisfy a different closed-formation condition, we have for the errors defined by that while for the condition implies . Then, if we combine these conditions, for the general system matrix the relation is . It is important to notice that, in the last expression, the coefficient for every , , is related with the cyclic paths in which the agent is involved. Even more, if a linear dependency among error variables can be found, then it is always possible to focus the analysis on reduced systems as in previous cases. Then, we present the next result for a more general class of communication graphs.
Theorem 10. Consider a group of agents moving in the plane, described by (13) along with the control law (16). Consider now a connected formation graph which is composed entirely as the superposition of different cyclic paths. Then, in the closed-loop system (13)–(16) the mobile robots converge to the desired formation in finite time.
Proof. For this case, knowing that the stability of the closed-loop system can be analysed using the system without normalizationwhere , with defined as in Section 2. If there are different cyclic paths described by , , also different closed-formation conditions can be stated. The combination of all these conditions leads towhere represents the number of cycles the th agent is involved with. As the communication graph is connected there exists a single zero eigenvalue while the rest satisfy . Using (37) the system can be reduced to the first error variables such thatwith defined as above, and having strictly positive real part eigenvalues. This implies again that as which also means as . As a result, the whole closed-loop system is asymptotically stable and as a consequence, by application of Proposition 4, in the system (13)–(16) the agents reach the desired formation in finite time.
Remark 11. Corollary 8 and Theorem 10 are extensions of the results presented in [5], where the simplified case of the directed cyclic pursuit formation graph was studied. A complete generalization of this result would be the study of finite time formation control using general communication graphs possessing a spanning tree [18]. This is left as an issue for future research.
4.2. Repulsive Vector Fields
Once we have shown the finite time convergence for agents, we attend the noncollision problem by designing a proper complementary control law based on repulsive vector fields focusing on the distance among agents. For this purpose it is useful to define the relative distance variables and , , . Note that if we consider the plane , we can identify the origin as a collision between th and th agents and a circle of radius , centered at the origin as the influence region between any two agents. Outside this circle, only attractive vector fields prevail while inside the circle the discontinuous repulsive vector fields appear. This is shown in Figure 3.
The first step to design the repulsive vector fields is done regarding the most simple case of a scenario when only two robots are in risk of collision. Then, the situation is geometrically generalized to the case of a robot rounded by a group of possible colliding robots. The vector fields are proposed in such a way that for robot there exists an unstable counterclockwise focus, centred at the position of the other robots. The general expression of the repulsive vector fields iswhere and the functions depend on the distance between and ; in the next waywhere is the minimum allowed distance between any pair of agents. If the sensed area is the same for all agents, it is clear that , . Finally, the control law for each agent is given bywhere is given by (16) and is given by (39). Now consider the case when there exist collision risk between agents and only while the rest of agents are far enough each one from the others. Then , and the dynamics of and areRegarding the described situation, we state the next theorem that is fundamental because it is the most simple case of danger of collision.
Theorem 12. Consider the system (13) and the control law (41) along with definitions (16), (39), and (40). Suppose that there exists risk of collision between only two agents at time instant and that the design parameter satisfies . Then, in the closed-loop system (13)–(41) the mobile robots reach their desired position at finite time and they stay for all at a distance greater than or equal to .
Proof. Assume first that there are agents without danger of a collision; then it is necessary to show and will avoid collision between them and stay at some minimum distance from each other. As mentioned above, there exists a circle, given bywhere the composite control law becomes discontinuous. Under the mentioned scenario, the trajectories defined by and lie inside the region . Once the repulsive vector fields appear, the behaviour of trajectories is determined by analysing the time derivative of (43) evaluated along the closed-loop system. The dynamics of relative position variables isThen,At this point, it is necessary to ensure that ; in the inner region . That means the resulting vector field inside the discontinuous surface points outwards. First consider the case when the attractive vector field points to inside the surface. Then, the constant should be selected in such a way that . Taking the case where attractive fields for both agents point to each other, resulting in the most negative magnitude in and restricting our analysis to the limit of the discontinuous surface, where , we can easily check that the time derivative of is bounded from below bytherefore if then . This implies that there exists a repulsive resulting vector field between and such that they will reject each other at least until they reach a distance . Moreover, since , then the agents not only avoid the collision but also satisfy for all time.
Even though the control laws proposed in this paper are not intended to produce a sliding mode motion, in case that the attractive vector fields outside the surface point to the surface , then a sliding behaviour should exist on the surface such that the agents stay at a distance , until there exist conditions for the trajectories to leave the surface . This situation might occur depending on the initial conditions, [21, 22].
In order to generalize the problem under discussion, it is insightful to consider now the situation of having three different robots , , and and possible collision risks between and and and as shown in Figure 4. This leads to present the next result, where we show the reasoning to generalize the noncollision scenario.
Theorem 13. Consider the system (13) and the control law (41) along with definitions (16), (39), and (40). Suppose that there exists a risk of collision among three agents at time instant , as shown in Figure 4, and that . Then, in the closed-loop system (13)–(41) the mobile robots reach their desired position in finite time and they stay at a distance greater than or equal to for all .
Proof. In this case, due to the possible collision among the different agents, the discontinuous surface consists of two different components, each one being related with a pair of agents; that is,According to Figure 4, which implies the dynamicsTo analyse the behaviour on the discontinuity surface we use the positive definite functionwhose time derivative is given byEvaluate considering that the trajectories lie in the inner region of , which implies ; that is, and , with . Hence,where . Now, we bound the norm of the difference of unitary vectors asTherefore, is bounded from above bywhere . Since we have selected , we getwhich finally implies thatThen, the trajectories of the closed-loop system point outwards of the surfaces in every point inside . As it was assumed, for any initial conditions the trajectories start outside ; then, in order to avoid getting into the surface, it is enough to ensure that they point towards the surface as ; this means that , ensuring the distance between agents will be greater than or equal to the predefined distance . This concludes the proof.
At this point, we would add more agents to analyse a more complex collision problem. Geometrically, the most general case occurs when a robot is surrounded by 6 other agents. Figure 5 shows this case, where is in danger of collision with 6 other robots, and any of these 6 robots is in danger of collision with other 2 robots only. The behaviour of the surrounding agents has already been analysed. This occurs when all of them are at distance from each other. Now, we can state our second main result, proceeding by induction to propose a solution to the general noncollision problem.
Theorem 14. Consider the system (13) and the control law (41) along with definitions (16), (39), and (40). Suppose that there exists a risk of collision among agents at time instant , as shown in Figure 5 and . Then, in the closed-loop system (13)–(41) the mobile robots reach their desired position in finite time and they stay at a distance greater than or equal to for all .
Proof. For simplicity, and without loss of generality, let us denote by the robot at the center of the configuration shown in Figure 5 and assume that there are robots around . The cases and have already been analysed, resulting in conditions and , respectively. Then, to proceed by induction, we take the Lyapunov function , with , whose time derivative satisfies if for . Now, we analyse the case for possible colliding robots; then the discontinuous surface is composed of components given byAccording to Figure 5, ; therefore the dynamics of the relative position variables areConsider now the positive definite functionThe time derivative of in terms of the functions isBy hypothesis, ; then we have to ensure for . This is achieved if the product . Then, since we are evaluating the Lyapunov function inside the surface , , the analysis reduces to show that ; hencewhich evaluated along the dynamics of the closed-loop system becomesTaking into account that we are analyzing the closed-loop system behaviour inside the region . Then, we haveIf we take the most negative possible case, we haveand, reduces in the worst case to
If we take the proposed condition can be easily verified that resulting in a general requirement for ensuring . Again, if we consider the trajectories of the closed-loop system start outside , this condition becomes . This implies the repulsive vector fields will reject agents from each other keeping them to a distance greater than or equal to the minimum allowed distance . Since there does not exist any condition where a given agent can be in a risk of collision with more than 6 robots, this concludes the proof.
5. Numerical Simulation Results
A numerical simulation was carried out in order to illustrate the performance of the proposed algorithm. The simulated system consists of nine mobile robots and the goal is to reach the formation shown in Figure 6, where the relative position vectors are defined as , , , , and . The constant velocity when no collision risk exists is and the minimum allowed distance is . According to the condition found above, the parameter was set to to ensure the minimum distance condition will not be violated.
Results are shown in Figures 7 and 8. In Figure 7 all the possible distances among agents have been drawn. Despite the apparent complexity of this graph, two aspects are to be emphasized. First, note that the distance between any pair of agents is always greater than or equal to the predefined distance . Second, and perhaps more interestingly, note that some agents converge to their desired positions without sliding, while some others reach the discontinuity surfaces , and slide for some time interval until they eventually escape and reach the desired configuration. On the other hand, in Figure 8 the positions of agents corresponding to selected time instants are shown. The convergence to the desired formation becomes clear. An animation of the time evolution of the closed-loop system can be found in the attached supplementary material (Supplementary Material available online at http://dx.doi.org/10.1155/2015/948086).
6. Real-Time Experiments
For real-time experiments, we used unicycle-type robots as agents. For this reason, the control strategies previously developed are modified for the case of this type of mobile robots. The kinematic model for each robot , according to Figure 9, is given by where is the longitudinal velocity of the middle point of wheels axis of the th robot, is its angular velocity, and is the orientation with respect to the -axis. It is known that systems like (65) cannot be stabilized by any continuous and time-invariant control law [23]. For this reason, to avoid singularities in the control law, it is common in the literature [16, 19] to study the kinematics of a point off the wheels' axis. The coordinates of point are given by
The kinematics of point is given bywhereis the decoupling matrix for each robot . The decoupling matrix is nonsingular since . By defining auxiliary control variables it is possible to establish a strategy for controlling the position of the point bywhereis the inverse of the decoupling matrix. The closed-loop system (67)–(69) producesThe desired position of robot , related to the coordinates , is given byThen, a formation control with collision avoidance, similar to that presented in Section 4, is defined aswhere and are similar to the case of point robots but related to coordinates . It is clear that (71) is the same as the case of point robots presented in (13). Thus, the analysis of convergence and collision avoidance is reduced to the case of point robots presented before. Although the control strategy (69) steers the coordinates of the points to a desired position, the angles remain uncontrolled.
When a robot is near its equilibrium point, the formation control law induces the so-called chattering phenomenon, which is highly undesired. To eliminate the chattering effects we propose to switch to a proportional control in a small neighborhood of radius , close to the equilibrium point. Hence, the control law is given byThe ratio helps us to avoid an abrupt change in the control law when we switch from the normalized control law to the proportional one. The value was chosen so that the chattering effects are alleviated. In our case, we have tried different values until obtaining a satisfactory result.
6.1. Experimental Platform
The real-time experiments were carried out over an experimental setup composed of the following elements.(i)Four differential-drive mobile robots, model AmigoBot manufactured by MobileRobots Inc. (Figure 10): Each one is furnished on the top with infrared markers which form a geometric pattern such that the centroid of this figure coincides with the middle point of the wheels’ axis of each robot for identification. The parameters of AmigoBot robots are wheel radius meters, length of wheels axis meters, distance to the front point of the robot meters, sonar sensors to avoid collisions or locate obstacles, and the maximum longitudinal velocity of m/s. They feature wireless serial ethernet for remote operations, two position encoders, and built-in velocity controllers. The workspace measures are meters. The linear and angular velocities and obtained from the control law developed in this paper are transformed into linear velocities of the right and left wheel , through the isomorphism: Note that in (75) the value of is not used because the information sent to each mobile robot is the linear velocity of each wheel.(ii)A positioning system: The position and orientation of each robot is measured through a vision system composed of cameras Flex 13 manufactured by Natural Point (Figure 11) which are located at a height of meters. These cameras have a resolution of pixels with a frequency of frames per second. To detect an object, it must have a minimum of 3 markers and at least cameras must locate the object within their range of vision.(iii)One Intel core i3-based computer: The software Motive calculates the position of the centroid of the geometric figure formed by the markers and its orientation. The control law is calculated in Visual C++ using Aria libraries which are also used to communicate with the robots. The protocol VRPN is used to share information between Motive and Visual C++. Finally, the velocities of each wheel are sent through Wi-Fi to the robots.
6.2. Real-Time Experiment
The experiment consists of four agents and the goal is to reach the square formation shown in Figure 12 where the relative position vectors are defined as , , , , , and . The constant velocity when no collision risk exists is m/s, the minimum allowed distance is meters, meters, and the parameter was set to . In this case, the theoretical value of has to be . Even though the value of used in the experiment is less than the theoretical value, the experiment was successful because one robot can only be in collision danger with at most two robots simultaneously. The initial conditions for the agents are , , , and . Figure 13 shows a comparison between a numerical simulation and a real-time experiment of the trajectory in the plane of the agents. As can be seen, numerical simulation and real-time experiment responses are close, but they exhibit some differences. This can be explained by a number of reasons amongst the following: the theoretical results are valid for first-order systems, while the real robots are modeled by second-order differential equations. Second, the employed kinematic model does not take into account dynamic effects like mass, inertia, and so forth. Despite these differences, the multiagent system converges to the desired formation.
Figure 14 shows the position errors of both the numerical simulation and real-time experiment, which converge to zero allowing the agents to achieve the desired formation.
(a) Position error of
(b) Position error of
(c) Position error of
(d) Position error of
In Figure 15 all the possible distances among agents are depicted. Notice that the distance between agents in the real-time experiment is lower than the design parameter . This is explained because of some dynamics that are not taken into account in the model.
(a) Distances in the experiment
(b) Distances in the simulation
Finally, Figure 16 shows the control inputs to achieve the desired formation. Once the agents are aligned into the desired geometric pattern the longitudinal velocity as the angular velocity converges to zero. The attached file shows a video of this real-time experiment.
(a) Velocities of
(b) Velocities of
(c) Velocities of
(d) Velocities of
7. Conclusions
A solution to the general noncollision problem in formation control has been proposed. This solution is based on the combination of attractive and repulsive vector fields. The attractive forces are designed proportionally to the error of each robot. The repulsive vector fields are designed as unstable focus centred at the position of the other robots. Besides, the attractive field was normalized to ensure the agents move at constant velocity when no danger of collision exists. As a by-product, finite time convergence is ensured. We analysed geometrically all the possible cases of multiple collisions and we proved the proposed control law is suitable in all situations, ensuring that the agents reach the desired geometric pattern in finite time and that they stay at a distance greater than a predefined bound. As a further research, the analysis can be extended not only to a general class of formation graph possessing a spanning tree but also to nonholonomic robots. Moreover, the differences that can be seen between the real-time experiment and the numerical simulation, due to unmodeled dynamics, motivate us to extend our work considering second-order agents.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.
Acknowledgments
J. F. Flores-Resendiz, J. González-Sierra, and J. Santiaguillo-Salinas acknowledge partial financial support from CONACyT, Mexico, in the form of Grants no. 202955, 219257, and 243226, respectively.
Supplementary Materials
The attached video contains an animation consisting in a group of nine agents under the proposed control law. The initial positions have been selected randomly and they reach the desired formation in less than 10 seconds. It is clear that no collision between agents occur and that the agents converge to their desired positions in finite-time. A real-time experiment is included in the video as well. There, a group of four unicycle-type robots achieves a prescribed formation avoiding collisions. The agents’ position and orientation are estimated through a vision positioning system, The value of physical and design parameters are detailed in the article.