Abstract

We describe a decentralized formation problem for multiple robots, where an formation controller is proposed. The network of dynamic agents with external disturbances and uncertainties are discussed in formation problems. We first describe how to design social potential fields to obtain a formation with the shape of a polygon. Then, we provide a formal proof of the asymptotic stability of the system, based on the definition of a proper Lyapunov function and technique. The advantages of the proposed controller can be listed as robustness to input nonlinearity, external disturbances, and model uncertainties, while applicability on a group of any autonomous systems with -degrees of freedom. Finally, simulation results are demonstrated for a multiagent formation problem of a group of six robots, illustrating the effective attenuation of approximation error and external disturbances, even in the case of agent failure or leader tracking.

1. Introduction

All around the world, nature presents examples of collective behavior in groups of insects, birds, and fishes. This behavior has produced sophisticated functions of the group that cannot be achieved by individual members [1, 2]. Therefore, the research on the coordination of robotic swarms has attracted considerable attention. Taking the advantages of distributed sensing and actuation, a robotic swarm can perform some cooperative tasks such as moving a large object that is usually not executable by a single robot [37]. Applications about the analysis and design of robotic swarms included autonomous unmanned aerial vehicles, congestion control of communication networks, and distributed sensor networks autonomous, and so forth [1, 2, 810].

In general, a robotic formation problem is defined as the organization of a swarm of agents into a particular shape in a 2D or 3D space [8]. This kind of control strategy can be applied into several different fields. For example, in the industrial field, this formation control strategy can be applied to a group of Automated Guided Vehicles (AGVs) moving in a warehouse for goods delivery. The main idea is to make a group of AGVs cooperatively deliver a certain amount of goods, moving in a formation. The creation of a formation with the desired shape is useful to precisely constrain the action zone of the AGVs, thus reducing the chance of collisions with other entities (e.g., human guided vehicles).

In the literature, many different approaches to formation control can be found. The main existing approaches can be divided into two categories: centralized [11] and distributed [12]. Because of the intrinsic unreliability of centralized methods, we focus our attention to distributed ones: all the agents are equal, and if one of them stops working, the other ones can still complete their task. Several formation control strategies can be found as potential fields [8], behavior-based [13], leader-following [1416], graph-theoretic [12], and virtual structure approaches [17, 18].

In recent years, some methods based on potential fields are integrated with some nonlinear control schemes such as feedback linearization method (e.g., Sliding Mode Control (SMC)), which concludes in more robust formation control designs of dynamic agents [1518]. For example, Takahashi et al. [15] proposed an SMC-based formation control scheme for multiple mobile robots, using the leader-following strategy, in which they defined some performance indexes, so that robots can be controlled according to their ability. Defoort et al. [16] also developed a robust coordinated control scheme based on leader-follower approach to achieve formation maneuvers. They used first- and second-order SMC to address the formation problem of mobile robots of unicycle type with two driving wheels. Moreover, Cheaha et al. [17] presented a region-based shape controller for a swarm of fully actuated robots, where a linear approximator was used to approximate the unknown dynamic model and an SMC controller integrated with artificial potential functions was used to satisfy a predetermined geometric 2D formation.

Recently, optimal control techniques have been found to be an effective solution to treat robust stabilization and tracking problems, in presence of external disturbances and system uncertainties [1924]. In an control technique, the main design goal is to force the gain from unmodelled dynamics, external disturbances, and approximation errors to be equal or less than a prescribed disturbance attenuation level ( attenuation constraint) [19]. This goal is generally represented as a Linear Matrix Inequality (LMI) problem.

In the traditional control the exact model of the system must be known. However, in order to propose a robust control method, an integration between this robust scheme with fuzzy logic approximators can propose effective controllers for uncertain dynamic models [25].

Since Zadeh [26] initiated the fuzzy set theory, fuzzy logic systems (FLS) have been widely applied to many real world applications [2730]. However, fuzzy control has not been viewed as a rigorous science due to a lack of formal synthesis techniques which guarantee the very basic requirements of global stability and acceptable performance. In fact, if the mathematical model of a robot is known, then conventional linear and nonlinear approximation methods should be given higher priority. However, fuzzy control should be useful in situations where (1) there is no acceptable mathematical model for the robot and (2) there are experienced human operators who can satisfactorily approximate the plant and provide qualitative control rules in terms of vague and fuzzy sentences. There are many practical situations where both (1) and (2) are true. Besides, FLS schemes have been widely used in motion control of single robots [31, 32]. Using FLS integrated with control technique can improve the robustness of controller and ensures the stability [25].

In this paper, a geometric formation is considered as the goal and an artificial potential is defined to guide the agents through this formation. A partially unknown nonlinear dynamic model is adopted to each -degrees of freedom agent. Therefore, an adaptive interval type-2 fuzzy approximator is combined with control technique to propose a novel decentralized adaptive fuzzy formation control methodology, with robust characteristics. The main advantage of this control strategy is insensitivity to robot dynamic uncertainties, external disturbances, and input nonlinearities.

Moreover, in existing adaptive nonlinear control methodologies which are based on SMC control (e.g., [17]), each agent approximator needs to know the position and velocity of all other robots to approximate the unknown model dynamics; however, in the current proposed decentralized strategy, only the position and velocity of each robot are enough to be known to its approximator.

The rest of this paper is organized as follows: Section 2 presents the system description, problem formulation, and potential function evaluation. An introduction of interval type-2 fuzzy logics systems is described in Section 3. Design of the proposed controller and stability analysis are discussed in Sections 4 and 5, respectively. Simulation results are included in Section 6 and Section 7 provides the concluding remarks.

2. System Description and Problem Formulation

The major goal in this study is to solve a multiagent formation control problem (i.e., controlling the relative position and orientation of the agents to create a desirable formation). One of the effective solutions for this problem is using an electrostatic-like potential function design which guides the agents through continues smooth paths and avoids agent collisions. Such a potential function design has been discussed in various papers (e.g., [1, 2, 8, 18]). Therefore, in Section 2.1 we will explain a simple potential function design, in order to solve the formation control of a group of point massless agents, where the kinematic of the agent is considered as in which is the coordinate matrix (for a robot with -degrees of freedom) and denotes the control inputs.

However, one of the main shortcomings of this kinematic model is that it does not correspond to the dynamics of realistic agents. To overcome this shortcoming more general dynamic models like unicycle models [33] or other wheeled vehicle models can be discussed.

In Section 2.2 one of the most general -degrees of freedom dynamic models of real robots is considered to propose more realistic solutions for formation control of multiagent systems. The main feature of this model is that any agent (robot) with -degrees of freedom (e.g., Autonomous Underwater Vehicles (AUVs) [34], Unmanned Aerial Vehicles (UAVs) [35, 36], etc.) can be adopted to this model.

2.1. Formation Control Massless Agents

To propose a control law, an artificial potential function is designed. This potential function can be comprised of interagent interactions, environmental effects (e.g., obstacles, goals, etc.), or other exceptional terms.

Consider the pairwise potential fields, which are defined between agents as where is designed to define a proper interagent potential function. It is assumed that each agent senses the resultant potential of all other agents.

The overall potential function is proposed to be in the form of where defines the global potential of each agent.

Finally, the following three assumptions for potential function are considered [17, 18].

Assumption 1. is continuously differentiable.

Assumption 2. is strictly convex.

Assumption 3. is positive definite.

For example, the following potential function can be chosen for a desired polygonal formation in a 2D Space:

At the first step, to propose a solution for multiagent formation control, the steepest descent direction [8, 17, 18] is chosen as and the control law is proposed.

By substituting (6) in (1) the kinematic model is obtained as which can be rewritten in the matrix form as where is the overall generalized coordinate vector.

In the next subsection, it is proposed to assume the multiagent system with a general dynamic model. Furthermore, in Section 3 a robust adaptive fuzzy controller using an approach is used to force the satisfaction of (7). In other words the proposed controller is designed to enforce the speed of each agent along the negative gradient of potential function in (7).

2.2. Formation Control of Robots with Dynamic Models

In this subsection a general dynamic model [37] is addressed to represent any kind of autonomous -degrees of freedom system. This model has been previously used in some existing works (e.g., [17, 18]).

Consider a group of fully autonomous agents. The dynamics of the ith simple agent is strongly nonlinear [37] and can be written in the general form where is the coordinate matrix (for a robot with -degrees of freedom); is a symmetric positive definite matrix and represents the inertia coefficients. is the matrix of centripetal, Coriolis, damping, and rolling resistance forces; is an -vector of gravitational forces and denotes the control inputs.

In most practical control problems of multiagent systems the inertia matrix is a known constant matrix independent of . Therefore, the following assumption is considered.

Assumption 4. is the inertia matrix of robots, which is assumed to be a known and constant matrix.

Let us rewrite (8) as

It is straightforward to rewrite (9) as

In the next sections, the dynamic of each single agent will be assumed to be in the form of (10).

3. Interval Type-2 Fuzzy Logic System

In this section, the interval type-2 fuzzy set and the inference of the type-2 fuzzy logic system will be presented. A type-2 fuzzy set in universal set is denoted as which is characterized by a type-2 membership function in (12). The can be referred to as a secondary membership function or referred to as a secondary set, which is a type-1 fuzzy set in . In (13), is a secondary grade, which is the amplitude of a secondary membership function; that is, . The domain of a secondary membership function is called the primary membership of . In (13), is the primary membership of , where for all ; is a fuzzy set in , rather than a crisp point in ,

When , then the secondary MFs are interval sets such that in (13) can be called an interval type-2 MF. Therefore, the type-2 fuzzy set can be rewritten as

Also, a Gaussian primary MF with uncertain mean and fixed standard deviation having an interval type-2 secondary MF can be called an interval type-2 Gaussian MF (13). It can be expressed as

It is obvious that the type-2 fuzzy set is in a region, called a footprint of uncertainty (FOU) and is bounded by an upper MF and a lower MF, which are denoted as and , respectively. Hence, (13) can be reexpressed as

A type-2 fuzzy logic system (FLS) is very similar to a type-1 FLS as shown in Figure 1; the major structure difference being that the defuzzifier block of a type-1 FLS is replaced by the output processing block in a type-2 FLS which consists of type-reduction followed by defuzzification.

There are five main parts in a type-2 FLS: fuzzifier, rule base, inference engine, type reducer, and defuzzifier. A type-2 FLS is a mapping . After defuzzification, fuzzy inference, type reduction, and defuzzification, a crisp output can be obtained.

Consider a type-2 FLS having inputs and one output . The type-2 fuzzy rule base consists of a collection of IF-THEN rules, as in the type-1 case. We assume there are rules and the rule of a type-2 relation between the input space and the output space can be expressed as where are antecedent type-2 sets () and s are consequent type-2 sets.

The inference engine combines rules and gives a mapping from input type-2 fuzzy sets to output type-2 fuzzy sets. To achieve this process, we have to compute unions and intersection of type-2 sets, as well as compositions of type-2 relations. The output of inference engine block is a type-2 set. By using the extension principle of type-1 defuzzification method, type-reduction takes us from type-2 output sets of the FLS to a type-1 set called the “type-reduced set.” This set may then be defuzzified to obtain a single crisp value.

There are many kinds of type-reduction, such as centroid, height, modified weight, and center-of-sets. The center-of-sets type reduction will be used in this paper and can be expressed as: where is the interval set determined by two end points and , and . In the meantime, an interval type-2 FLS with singleton fuzzification and meet under minimum or product t-norm and can be obtained as

Also, and are the centroid of the type-2 interval consequent set . For any value , can be expressed as where is a monotonic increasing function with respect to . Also, is the minimum associated only with , and is the maximum associated only with . Note that and depend only on mixture of or values. Therefore, the left-most point and the right-most point can be expressed as a fuzzy basis function (FBF) expansion, that is, respectively, where and .

If the FBF vector denoted as and , and let and , then (20) can be rewritten as

For illustrative purposes, we briefly provide the computation procedure for . Without loss of generality, assume the are arranged in ascending order, that is, .

Step 1. Compute in (22) by initially setting for , where and have been precomputed by (18) and (19) and let .

Step 2. Find such that .

Step 3. Compute in (22) with for and for and let .

Step 4. If , then go to Step 5, If , then stop and set .

Step 5. Set equal to and return to Step 2.

The point to separate two sides by number can be decided from the above algorithm, one side using lower firing strengths ’s and another side using upper firing strengths ’s. Therefore, the in (22) can be rewritten as where , and . In the meantime, we have , , , and .

The procedure to compute is similar to compute . Just in Step 2, we determine , such that and in Step 3 let for and for . Then in (21) can also be rewritten as where , and . In the meantime, we have , , , and .

The defuzzified crisp value from an interval type-2 FLS is obtained as where and .

4. Controller Design Methodology

In this section a novel formation error based on the integral of formation gradient (5) will be proposed. Then, a robust controller will be designed and a fuzzy logic system will be utilized to approximate the unknown parts of dynamic models. The main feature of the proposed novel control scheme is its decentralized characteristic, robustness to external disturbances, input nonlinearities, and measurement noises. Besides, by using the proposed controller, the formation can be achieved from any initial conditions.

Consider, the novel formation error for the robot as where , represents the coordinate vector of robot in (10) and is the gradient of potential function defined in (7). It is straightforward to write the first and second derivatives of (26) as

Our design goal is to propose an adaptive fuzzy controller so that is achieved, where and are chosen to make (28) asymptotically stable.

To design the controller, consider the control law proposed as where

In order to use this control law, which is designed based on the feedback linearization control method, the function (i.e., and ) must be known. However, in practice these matrices may be unknown for most of real dynamical robots. To overcome this, we make use of an adaptive fuzzy logic system to approximate .

Therefore, using the singleton fuzzifier, product inference, and weighted average defuzzifier [38], the output of the fuzzy model can be expressed as where

Equation (31) suggests to us to rewrite the overall control law (29) as where is engaged to attenuate the fuzzy logic approximation error and external disturbances.

A block diagram of the proposed control methodology is shown in Figure 2.

Remark 1 (input nonlinearity). In what follows, another main property of the proposed is introduced. It will be shown that the formation problem of multiagent system can be achieved even in the presence of dead-zone nonlinearities of the control actuators. Let us modify the dynamic model (9) as where and represents the dead-zone function and can be expressed as where is the width of the dead-zone and is the slope of dead-zone line.

The dead-zone parameters and are assumed to be bounded and the bounds of and are known as and . Therefore (36) can be rewritten as

From the aforementioned assumption on bounds of and , can be assumed bounded, (i.e., ), where is the known upper bound that can be chosen as . By considering and , where then (34) can be rewritten as which is the same as (9). Therefore, we have proved that the proposed feedback controller is also robust to dead-zone input nonlinearities (36).

5. Stability Analysis

This section presents the stability proof of the proposed novel adaptive fuzzy controller in (33). A Lyapunov candidate will be proposed and then an adaptation law and a robust compensator control input will be derived to satisfy the tracking performance in (50).

To derive the adaptive law for adjusting , we first define the optimal parameter vector as and the minimum approximation error is defined as where it can be assumed that [38].

By choosing the control input as [39] after some manipulations, (10) can be rewritten as and the formation error dynamic can be expressed as

Moreover by defining it is straightforward to write where

Based on (31), (40), and (41), the matrix form of formation error in (44) can be rewritten as where .

In the following theorem, it will be shown that the proposed control law (33) guarantees the stability and robustness of formation problem.

Theorem 2. Consider a group of fully autonomous agents with the dynamic represented in (8) and with the control law in (33). The robust compensator of th robot and the fuzzy adaptation law are chosen as where and are positive constants and is the positive semidefinite solution of following Riccati-like equation: where is a positive semidefinite matrix and .

Therefore, the tracking performance can be achieved for a prescribed attenuation level and all the variables of closed loop system are bounded.

In order to derive the adaptive law for adjusting , the Lyapunov candidate is chosen as

Using (46), the time derivative of is

Substituting (47) in (52) and using the fact that , we get

Using adaptation law (48) and the Riccati-like equation (49), the above equation becomes

Integrating the above inequality from to yields to

Using the fact that and from (49), the inequality is obtained.

Therefore, the tracking equation (50) can be achieved and the proof is completed.

6. Simulation Results

This section presents four simulation examples to illustrate the effectiveness of the proposed control scheme. In the first example, a group of six agents with known dynamics as in (8) is considered. The second example presents the hexagonal formation of six partially unknown agents and an adaptive fuzzy logic system is used to approximate the unknown dynamics. This example proves the system stability under the proposed novel controller. In order to prove the controller robustness, in the third example a white Gaussian noise is applied to all measured data and one of the agents is forced to be stationary and still the formation maintains its stabilizing performance. In the forth example one of the agents is chosen as the leader with a constant velocity. It is shown that proposed controller is able to form a dynamic 2D moving hexagon which tracks the leader. All the simulation results are implemented in MATLAB with 0.01 secs as the stepsize.

The unique formation problem used in all five simulation examples is a hexagon with unit radius defined by where is specified in Table 1.

In addition six random points in the 2D space are chosen to be the initial positions for six agents. These points are assumed to be fixed in all five numerical simulations (Table 2).

6.1. Example I (Six Agents with Known Dynamics)

Consider a group of six mobile agents with known dynamic models. Based on general model represented in (8), the nonlinear dynamic of the robot is considered as and after some manipulations we get

To give a solution for the formation problem, formation error is defined as (26) and the control law is designed based on (29), where and . Figure 3(a) shows the formation trajectory of six robots starting from initial conditions (Table 2) to the final unit hexagon (57) in 30 secs and Figure 3(b) shows the potential value.

The first subfigure (Figure 3(a)) shows how smooth the controller guides all the agents to form the desired hexagon. This geometric formation does not have any fixed position or direction, and it will only be determined by the agents initial position.

The second sub-figure (Figure 3(b)) illustrates the potential decrement through the time. It is shown that the potential is forced to get stabilized in less than 20 secs and it will be shown that the settling time for next simulation examples will more than 20 secs.

6.2. Example II (Six Agents with Partially Unknown Dynamics)

To verify the effectiveness of proposed method the same novel formation error and (26) are chosen, respectively. Consider a group of six agents with the same dynamic models as (59). However, to design the control law, the dynamic model of agents is assumed to be partially unknown (i.e., and in (8) are unknown).

Therefore, six fuzzy logic approximators are designed to approximate the unknown dynamic, where each agent approximator just needs the current position and velocity of itself. Three Gaussian membership functions with unit variance are defined and all s are initialized from zero vectors. The learning rate in (48) is set to and the output of the fuzzy system is achieved by choosing singleton fuzzification, center average defuzzification, Mamdani implication in the rule base, and product inference engine [38].

Simulation results of the proposed adaptive fuzzy technique with agents initial positions as shown in Table 2 are shown as following. The motion trajectory in the first 30 secs is illustrated in Figure 4(a) and the formation potential (57) is shown to be stabilized in Figure 4(b).

6.3. Example III (Formation Problem in Presence of Measurement Noise and Agent Failure)

In this example the robustness of proposed controller in presence of measurement noise and agent failure will be proved. The proposed potential function (3) and gradient-based method proposed in Section 2 are able to obtain the exact formation even in the case of one agent failure. Therefore, in this example it will be shown that when Agent #3 is forced to be stationary with zero velocity, other agents move toward this agent to achieve the hexagon formation. In addition a white Gaussian noise with  db is applied to all the measured data. All of the model characteristics and controller designs are the same as previous example in Section 6.2. Motion trajectory and formation potential (57) of the first 90 secs of simulation are shown in Figures 5(a) and 5(b), respectively.

6.4. Example IV (Formation Problem While Tracking the Leader)

Previous example illustrated the good performance of formation stabilization, while agent failure (i.e., one agent remains stationary). However, the structure of potential function explained in (3) suggests to exempt one agent from the control law designed in (33), and let it move freely as the leader [8]. Therefore, to run a more general simulation than previous example where one agent was stationary, here one of the agents is chosen as the leader and moves with a constant speed to a predefined direction. Then it is anticipated that, after some transient formation, the agents position achieves the hexagon form in (57). All the problem parameters and controller design are the same as previous examples (i.e., (57), (59) and (42)). Agent #4 is chosen as the leader, with constant velocity as

The motion trajectory and formation potential (57) are shown in Figures 6(a) and 6(b), respectively.

Simulation results prove that by using the same control law as (33) even the moving formation can be achieved. It can be seen that the formation is achieved in about 70 secs; however, this numerical simulation contains negligible steady state error (Figure 6(b)).

7. Conclusion

In this paper, the formation control problem of a class of multiagent systems with partially unknown dynamics was investigated. On the basis of the Lyapunov stability theory, a novel decentralized adaptive fuzzy controller with corresponding parameter update law was developed and the stability of the system was proved even in the case of external disturbances and input nonlinearities. All the theoretical results were verified by simulation examples and good performance of the proposed controller was shown even in the case of agent failure, presence of measurement noise, and even moving formations.