Distributed Formation Control for Multiple Quadrotor Based on Multi-Agent Theory and Disturbance Observer
This paper presents the disturbance observers-based distributed formation control for multiple quadrotor aircrafts with external disturbances and uncertain parameters using multi-agent theory and finite-time control method. Firstly, the finite-time disturbance observers are proposed to handle the external disturbances on the position-loop. Similarly, when there are both the uncertain parameters and external disturbances on the attitude-loop, the finite-time disturbance observers are designed to estimate the total lump disturbances. By skillfully using homogeneous system theory, Lyapunov theory, and multi-agent theory, the distributed formation control algorithms are developed. Finally, through simulations, the efficiency of the proposed method (including the convergence rate and disturbance rejection) is verified.
With the development and application of the quadrotor aircraft, nowadays, the formation control problem for multiple quadrotor aircrafts has become a hot topic and attracted a great deal of attention. Compared to the fixed-wing aircraft, the quadrotor aircraft has many different features, such as simple structures, easy maintenance, and maneuverability, etc . Due to these advantages, the quadrotor aircraft has been widely used in the civilian field and the military field, such as aerial photography, geological survey, disaster relief, pipeline inspection, environmental assessment, etc. [2, 3]. Meanwhile, in some complex and specific environments, multiple quadrotor aircrafts have more advantages than a single aircraft. For example, multiple aircrafts can significantly improve the efficiency and the robustness of the whole system. In addition, more aircraft collaboration means more different equipment that can be carried on to accomplish more difficult tasks. From the control point of view, it is quite difficult and challenging to realize the formation control of multiple aircrafts because it is necessary to further coordinated control of multi-aircraft on the basis of controlling a single aircraft. Actually, even the design of control system and the analysis of stability for single quadrotor aircraft are also challenging since the model has highly nonlinear and strong coupling .
Up to now, a series of achievements have been made in the formation control problem. For the heterogeneous multi-agent systems with nonlinear dynamics, the leader-following consensus problem has been considered in . The work  studied a novel reliable consensus for uncertain nonlinear multi-agent systems in the presence of probabilistic time-varying delay. This article considers the leader-following consensus problem of heterogeneous multi-agent systems The time-varying formation tracking control has been realized for quadrotor aircrafts [7, 8]. Based on complex Laplacian, the work  studied the distributed formation control problem for multi-agent systems. Considering sampled-data and communication delays, the distributed formation controllers have been designed for mobile robots . The work  discussed the problem of vision-based leader-follower formation control for mobile robots.
However, note that most of the existing control algorithms are required to satisfy the Lipschitz continuity condition. In other words, the desired formation will be achieved at best exponential with an infinite time. As we all know, for the quadrotor aircraft, whether it is multiple formation control or single control, it is hoped that the convergence speed will be as fast as possible. To enhance the convergence rate and the ability of disturbance rejection, recently a nonlinear control method (i.e., finite-time control method) [12–14] was introduced. Theoretically, the finite-time control algorithm can guarantee that the system will stabilize in a finite time. Firstly, there have been already some results with regard to finite-time control for a single quadrotor aircraft [15–22]. Moreover, for the single quadrotor aircraft during the flight, the external disturbances are often unavoidable, such as wind disturbances. Some theoretical and experimental analysis were given in [13, 18, 23], to explain why finite-time control can offer better ability of disturbance rejection. Compared to the study of a single quadrotor aircraft, the results of finite-time research on multiple quadrotor aircrafts, especially the results of finite-time formation control, are still limited. Most of the existing finite-time formation control research results are mainly for multi-agents [24–26], mobile robots , etc. The high dimension and nonlinear coupling of multiple quadrotor aircraft systems make the controller design and stability analysis of the closed-loop system more difficult.
Based on the advantages of finite-time control, this paper will employ it to design a distributed formation control for multiple quadrotor aircrafts. It is worth noting that the results in most of the previous papers on formation control problems did not consider the effect of external disturbances, such as payload changes (or mass changes), wind disturbance, inaccurate model parameters, and so on. The robustness is an important aspect in the controlling of quadrotors. To improve the system dynamical performances, the finite-time position and attitude controllers are proposed for the nominal systems based on homogeneous systems theory. A quadrotor controller must be robust enough in order to reject the effect of disturbances and cover the change in model parameter uncertainties and external disturbances. To handle the external disturbances for the position-loop subsystem, the finite-time disturbance observers are deigned to estimate the disturbances in a finite time. Similarly, when there are both the parameter uncertainties and external disturbances for the attitude-loop subsystem, the finite-time disturbance observers are deigned to estimate the lump disturbances in a finite time. Compared with the existing results, the main contributions of this paper are as follows: (1) Construct the finite-time observers to achieve accurate estimation and compensation of disturbances. (2) Based on the finite time control technology, the system dynamical performances can be improved (i.e., faster convergence speed and better anti-interference ability). Finally, based on the finite-time disturbance observers, the finite-time distributed formation control strategy is developed for multiple quadrotor aircrafts, whose efficiency (including the convergence rate and disturbance rejection) is verified through simulations.
2.1. Problem Description
This paper mainly studies the formation control problem of a group of four-rotor aircraft. Then define . Generally speaking, the motion information to describe the an aircraft is mainly composed of six-degree-of-freedom variables, i.e., the position information and the attitude information. Specifically, the coordinates of the aircraft can be described aswhere denotes the position information by inertial coordinate system, and are Euler angles to describe the attitude information based on the inertial coordinate system.
2.1.1. Position Dynamical Model
From [28, 29], the position dynamical model for i- quadrotor aircraft can be described aswhere denotes the mass of the aircraft, represents the unknown external disturbances, is the total thrust produced by the four rotors, and is a positive constant, i.e., the gravitational acceleration.
2.1.2. Attitude Dynamical Model
The description of i- attitude dynamical equation is based on Euler angles , which is given aswhere is the inertia matrix in the body-fixed frame, represents three rotational forces produced by the four rotors, and are the constants, respectively, for the force-to-moment factor and the arm length of the aircraft, and denotes the unknown time-varying external disturbances.
2.2. Control Objective
The control objective of this paper is to design a a distributed control law for a group of quadrotor aircraft (3)-(4) such that the formation control can be achieved in a finite time. Specifically, define the desired formation trajectory . At the same time, as we all know, the geometry in 3D space can be described by vector . In other words, the relative positional deviation between aircraft i and aircraft j is expressed asBased on mathematical expressions, the control objective of this paper can be described as that there is a finite time such that for any and
To achieve the control objective, for each quadrotor aircraft, the following assumptions are imposed.
Assumption 1. Assume that the desired position trajectory is , where and are continuous and bounded.
Assumption 2. Assume that the external disturbances and the change rate of the disturbances are bounded; i.e., , , , are bounded.
To achieve the finite-time formation control task, we will employ the multi-agent theory to design a distributed formation control algorithm. Next, we first review the knowledge of graph theory.
2.3. Graph Theory
Considering a group of quadrotor aircraft with leader-follower structure, assume that each aircraft is a node and the information exchange among follower agents is denoted by a directed graph . is the set of nodes, is the set of edges, and is the weighted adjacency matrix of the graph with non-negative adjacency elements . If there is an edge from node to node , i.e., , then , which means there exists an available information channel from node to node . The set of neighbors of node is denoted by . The out-degree of node is defined as . Then the degree matrix of digraph is and the Laplacian matrix of digraph is .
A path in graph from to is a sequence of of finite nodes starting with and ending with such that for . The graph is connected if there is a path between any two distinct vertices.
Assume that the reference state is represented by a leader. The connection weight between the agent and the leader is denoted by . If the -th agent has access to the information of leader, then ; otherwise, . Let .
Assumption 3. For the communication topology, it is assumed that the graph for all follower agents is connected. Meanwhile, at least one agent has access the signal directly from leader.
2.4. Related Definitions and Lemmas
Since the main objective of this paper is to design a finite-time formation control algorithm, we first introduce the concept of finite-time stability.
Definition 4 (see ). For a nonlinear system,where is a continuous function. If the system is Lyapunov stable and finite-time convergent, then it is called finite-time stable. The finite-time convergence is defined as that there is a finite time such that and for all .
In addition, for brevity, we define the following notation.
Definition 5. Define functionwhere is sign function.
Finally, since the finite-time controller design in this paper is based on the homogeneous systems theory, we give the related definition and lemma about homogeneity.
3. Main Results
The controller design method is mainly based on the backstepping design and disturbance estimation-compensation method. Specifically speaking, the design procedure is divided into two steps.(i)Step 1: for the position subsystem, the attitude is taken as the virtual control input and is designed as the desired attitude such that all aircraft can converge to the desired 3D-pattern and move along the desired leader’s trajectory in a finite time. For the external disturbance, a finite-time disturbance observer is used to estimate and compensate the disturbance, i.e., disturbance estimation-compensation method.(ii)Step 2: for the attitude subsystem, by combining disturbance observer and finite-time controller, a control law is designed such that the each quadrotor desired attitude can be tracked by the real attitude in a finite time.
3.1. Finite-Time Position Formation Controller Design
For the sake of statement, denote under which the position system’s equation (3) can be rewritten as follows:In order to design a finite-time controller for system (11), we first consider the case without external disturbances.
3.1.1. Case 1: No External Disturbance
Lemma 8. For the position motion model (11) without the external disturbances, i.e., , if the controller is designed aswhere , , then the desired formation position control can be achieved in a finite time.
Proof. Since the three axis controllers are similar, without loss of generality, we will only give the proof process about -axis. Letbe the coordinate changes for i- quadrotor aircraft. Under the proposed controller (12), it can be concluded from (11) that the position tracking error equation isIn the sequel, we will prove that the system (14) is globally finite-time stable and the proof is divided into two steps.
At the first step, we will show that system (14) is globally asymptotically stable. The Lyapunov function is chosen aswhereClearly, the Lyapunov function is positive definite and radially unbounded. On one hand, the derivative of along system (14) isOn the other hand, based on and the function being an odd function, the derivative of along system (14) isIn summary, the derivative of along system (14) isSince , , , it is obvious that . Define set . It can be concluded that implies and , which also implies that from (14), . Using LaSalle’s invariant principle  leads to as ; i.e., system (14) is globally asymptotically stable.
Furthermore, according to the definition of homogeneous system (i.e., Definition 6), it can be found that system (14) is homogeneous with degree of with respect to the dilation , where , . In summary, based on Lemma 7, it can be concluded that the closed-loop system (14) is globally finite-time stable.
However, in practice, the external disturbance is usually unavoidable. Next, we will consider this case.
Assumption 9. Assume that there are known positive constants , , such that , .
3.1.2. Case 2: The Existence of External Disturbance
Proof. Similarly, here, only the proof about x-axis is given. Define the disturbance observer error as , under which the error dynamical equation can be obtained from (11) and (20) thatBy Assumption 9, we have . As a result, it follows from  that system (22) is finite-time stable under the gain condition (21), which means that can converge to in a finite time. The proof is completed.
Based on the precise estimations for the external disturbances, a disturbance-observer-based composite controller is given to achieve finite-time position tracking control.
Theorem 11. For the -th position motion model (11) with the disturbance, if the controller is designed aswhere , , then the desired formation position control can be achieved in a finite time.
Proof. The proof is straightforward since the results in Lemmas 8 and 10 are about finite-time convergence. In other word, there is a finite time , for any ,Therefore, considering the coordination changes (13), for any , it can be concluded thatTherefore, the formation control of a group of quadrotor aircraft can be achieved in a finite time. The proof is completed.
3.2. Attitude Controller Design
In the previous section, the attitude (i.e., Euler angle ) is taken as a virtual control input. It is designed such that the desired position trajectory can be tracked in a finite time. Next, in this section, the attitude dynamical system will be considered. According to the relation (10), the desired attitude can be generated from the virtual control input . Denote as the desired attitude for -th quadrotor aircraft; then it follows from (10) thatSince the variable is a free variable, the desired yaw angle can be set as for the convenience of analysis.
Due to both uncertain parameters and external disturbances, the unknown parameters are broken into two parts, i.e., known nominal parts and unknown uncertainty parts. Specifically, letwhere represents the known part and is the uncertainty part. With the help of the above notations, the attitude equation (4) can be rewritten aswhere
Remark 12. Note that the uncertainty functions, i.e., , defined above include not only the external disturbances but also the parameter variations, which are usually called the lumped disturbances in the literature .
To deal with the lump disturbances in system (29), a disturbance estimation and then compensation method will be employed. As that in [33–35], the following assumption is given on the lump disturbances.
Assumption 13. Assume that there are known positive constants , , such that , .
Under this assumption, motivated by the work , a finite-time disturbance observer is proposed to estimate the lump disturbances in a finite time.
Proof. The proof process is the same as that of the position loop disturbance observer, i.e., Lemma 10. The proof is straightforward.
Based on the precise estimations for the lump disturbances, a disturbance-observer-based composite controller is given to achieve finite-time attitude tracking control.
Theorem 15. For the attitude subsystem (4) of -th quadrotor aircraft in the presence of unknown parameters and external disturbances, if the controller is designed aswhere , , then the desired attitude can be tracked in a finite time, i.e., in a finite time.
Proof. Since the disturbance observers (30) are about finite-time convergence, then there is a finite time such thatSimilarly, only the proof about roll angle is provided. Define the attitude tracking error as , when , whose dynamical equation can be obtained from (28), i.e.,Under the proposed controller (32), the closed-loop system isIt can be found that the closed-loop system (35) has the same structure as that of system (14). Hence, based on Lemma 7, it is easy to prove that system (35) is globally finite-time stable, which is omitted here.
4. Numerical Simulations
To verify the proposed theoretical results in Theorems 11 and 15, some numerical simulations are given. The network system considered in this section consists of one leader and three followers. The undirected topology graph topology is shown in Figure 1. Specifically, the weights of the undirected edges are, respectively, given as , , . Meanwhile, the desired formation pattern is to form a regular triangle on in the - plane. And from Figure 1, the relative position deviations can been given as
4.1. Model Parameters and Controllers Gains
The desired formation trajectory, i.e., leader’s trajectory, is
And the initial conditions for each quadrotor aircraft are as follows:
4.2. Numerical Simulation Results
Under the proposed control algorithm, Figure 2 shows the position trajectory of each quadrotor aircraft in 3D space. It can be found that the desired formation control task can be achieved under the proposed finite-time controller. The tracking curve for each aircraft’s position and attitude are given in Figures 3 and 4. And the adjacent distance of all quadrotor aircrafts is shown in Figure 5. The response curves for the estimated position disturbances and the estimated attitude lump disturbances are, respectively, shown in Figures 6 and 7. It can be found that the proposed methods of finite-time disturbances estimation are effective.
In this paper, observers-based distributed formation control law has been proposed to solve the formation control problem for multiple quadrotor aircrafts in the presence of parameter uncertainties and external disturbances. Rigorous stability analysis and some simulation results have been presented to show that the formation task can be achieved using the proposed control algorithm.
No data were used to support this study.
Conflicts of Interest
The authors declare that there are no conflicts of interest regarding the publication of this paper.
This research is supported by Guangdong Science and Technology Plan Project with Research Grants 2017A020208068 and 2015A020209176, Guangzhou Science and Technology Plan Project with Research Grant 201704030131, and China Scholarship Council (CSC) Grant.
P. Castillo, R. Lozano, and A. Dzul, Modelling and Control of Mini-Flying Machines, Springer-Verlag, New York, NY, USA, 2005.View at: Publisher Site
A. Abdessameud and A. Tayebi, “Motion coordination for VTOL unmanned aerial vehicles,” in Advances in Industrial Control, Springer-Verlag, New York, NY, USA, 2013.View at: Google Scholar
X. Dong, Y. Zhou, Z. Ren, and Y. Zhong, “Time-varying formation tracking for second-order multi-agent systems subjected to switching topologies with application to quadrotor formation flying,” IEEE Transactions on Industrial Electronics, vol. 64, no. 6, pp. 5014–5024, 2017.View at: Publisher Site | Google Scholar
S. P. Bhat and D. S. Bernstein, “Finite-time stability of homogeneous systems,” in Proceedings of the American Control Conference, vol. 4, no. 4, pp. 2513-2514, Albuquerque, NM, USA, June 1997.View at: Google Scholar
H. Du, H. Shen, and W. Zhu, “Control of a hovering quadrotor aircraft based finite-time attitude control algorithm,” in Proceedings of the 12th IEEE International Conference on Control and Automation, ICCA 2016, pp. 192–197, June 2016.View at: Google Scholar
S. P. Bhat and D. S. Bernstein, “Finite-time stability of homogeneous systems,” in Proceedings of the American Control Conference, pp. 2513-2514, Albuquerque, NM, USA, June 1997.View at: Google Scholar
H. K. Khalil, Nonlinear Systems, Prentice Hall, Upper Saddle River, NJ, USA, 3rd edition, 2002.
H. Sun and L. Guo, “Neural network based DOBC for a class of nonlinear systems with unmatched disturbances,” IEEE Transactions on Neural Networks and Learning Systems, vol. 28, no. 2, pp. 482–489, 2017.View at: Google Scholar