Next Article in Journal
Application of Mode-Adaptive Bidirectional Pushover Analysis to an Irregular Reinforced Concrete Building Retrofitted via Base Isolation
Next Article in Special Issue
Analysis of Inductive Displacement Sensors with Large Range and Nanoscale Resolution
Previous Article in Journal
Self-Tuning Lam Annealing: Learning Hyperparameters While Problem Solving
Previous Article in Special Issue
Dynamic Stability of an Electric Monowheel System Using LQG-Based Adaptive Control
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Distributed Control for Coordinated Tracking of Fixed-Wing Unmanned Aerial Vehicles under Model Uncertainty and Disturbances

College of Intelligence Science and Technology, National University of Defense Technology, Changsha 410073, China
*
Author to whom correspondence should be addressed.
Appl. Sci. 2021, 11(21), 9830; https://doi.org/10.3390/app11219830
Submission received: 27 September 2021 / Revised: 19 October 2021 / Accepted: 20 October 2021 / Published: 21 October 2021
(This article belongs to the Special Issue New Trends in the Control of Robots and Mechatronic Systems)

Abstract

:
In this paper, we consider a control problem where a group of fixed-wing unmanned aerial vehicles (UAVs) with uncertain dynamics tracks the target vehicle cooperatively in the case of external disturbance. Based on the Gaussian process regression, a data-driven model is established, whose uniform error is bounded with probability. Then a learning-based consensus protocol for multi-UAVs is designed. The stability of the system is proven via Lyapunov function, and the tracking error is guaranteed to be bounded with a high probability. Finally, the effectiveness of the proposed method is shown in the numerical simulation.

1. Introduction

In recent years, cooperative tracking control of multi-UAVs has been developing rapidly for its wide application [1,2], such as pursuing recovery device in air-recovery [3], following aircraft in a cooperative operation [4] and tracking virtual leader in formation flight [5]. However, there exist many challenges in the research [2]. First, the nonlinear dynamics, in particular the unmodeled dynamics, of UAV make the design of control law more difficult. Second, the disturbance in the environment, such as wind, is to be considered in the coordinated control for the safety of the formation flight.
For the study of the model of fixed-wing UAV, 6 DOF model [6] is constructed in the early modeling of UAV, where aerodynamic parameters are used to refine the model characteristics. However, it is difficult to be applied in practice due to the coupling characteristics of the model and it is usually used in the maneuver flight with high speed, which relies on the attitude control [7]. To better analyze the movement of UAV in three-dimensional, most researchers adopt 3 DOF model [8,9] in their study. Furthermore, if the height remains unchanged, the 3 DOF model can be expressed as a unicycle model [10,11], which is a kinematic model without considering the dynamic characteristics of the UAV. To better analyze the tracking performance of the UAVs in the plane, a 2 DOF model is discussed in this paper based on the assumption that the height of the UAV is constant, which not only preserves the dynamics of the UAV but also simplifies the description of the problem.
Although most of the models we use are the nominal model, which is a standard model without uncertainties, there is still an uncertain part caused by parameter uncertainties and high-order dynamic terms, which is often difficult to be modeled by functions. Thus, data-driven model is widely used in the model-based control techniques with the development of computer technology. Gaussian process (GP) model is a Bayesian nonparametric regression model, which is widely used in the machine learning [12,13]. Compared with the neural networks (NNs) [9], GP does not only provide a prediction but also a prediction variance, an effective measure of the uncertainty of the learned model [14]. When model-based methods are used in control, model errors are of great importance to be taken into account [15]. GP provides uniform error bound [16,17], while there is no guaranteed bound of the estimation error in NNs [18]. To apply model-based control methods to data-driven models, we use GP regression to model the unknown dynamics of the UAV for its uniform error bound.
The main contribution of this paper is the design of a cooperative tracking control law for fixed-wing unmanned aerial vehicles based on GP, considering model uncertainty and disturbances. We model the unknown dynamics of fixed-wing UAV based on GP, take the disturbance into account, prove the stability of the system with the help of Lyapunov function and guarantee that the tracking errors are in a certain bound with a high probability.
The remainder of the paper is as follows: Section 2 reviews the works related to our research. In Section 3, some mathematical symbols are explained, and the basic knowledge of graph theory and Gaussian process regression is introduced. The mathematical description of control problem is established in Section 4 followed by the main results of our work in Section 5, where the learning-based control law for coordinated tracking is proposed and stability with probability for the system is proven. Section 6 shows the results of numerical simulation and demonstrates the effectiveness of the proposed method. Conclusion is drawn in Section 7.

2. Related Work

There are many applications based on Gaussian process, such as constructing maps [19], filtering [20], action recognition [21], classification of hyperspectral images [22,23] and modeling. In particular, modeling is one of the most important applications. Jongseok Lee et al. [24] proposed an identification framework for fixed-wing platforms, which includes flight test, training parameter, correcting identification and updating model. Khansari-Zadeh et al. [25] presented a method to learn discrete robot motions and demonstrates its validity through a set of robot experiments. With the wide applications of GP model, some researchers started to apply control methods to GP model. Prasad Hemakumara et al. [26] modeled the dynamic of UAV and controlled it in real flight. Sooho Park et al. [27] proposed a learning algorithm to learn the unknown system model and tested it on the control of the mecanum-wheeled robot. It is a pity that the above research lacks analysis of stability of the control system.
When it comes to the stability of control system based on GP model, we have to thank Niranjan Srinivas et al. [16] for their excellent work. They obtained explicit sublinear regret bounds for many commonly used covariance functions, which is cited by many researchers. Based on their theory, Jonas Umlauft et al. [28] put forward an uncertainty-based control Lyapunov function framework to stabilize control-affine systems with high probability, while Michael Maiworm et al. [14,29] designed a model predictive control law for nonlinear discrete time systems and established input-to-state stability. Armin Lederer et al. derived a novel uniform error bound under weaker assumptions.
All the research above applies to individuals. There exists a few data-driven control approaches for unknown nonlinear multi-agent systems (MAS) [18]. Zewen Yang et al. [18] designed a learning-based leader-follower consensus protocol for unknown nonlinear MAS based on GP. However, the model proposed by Zewen Yang et al. is relatively simple and does not apply to the design of control law of fixed-wing UAV, at the same time, the disturbance caused by changing wind and mutual airflow between UAVs is not considered, which is of great importance in the control of multi-UAVs. Although Wang Ping et al. [30]. and Michael Defoort et al [31]. had taken disturbance into account, they did not consider the uncertain dynamics of agents. Inspired by them, we design a cooperative tracking control law for fixed-wing unmanned aerial vehicles based on GP, considering model uncertainty and disturbance, and prove the stability of the proposed method.

3. Preliminaries

3.1. Notation

In this paper, vectors and matrices are represented by bold letters, while scalars are represented by normal letters. For a vector x R n , x is usual Euclidean norm of x , i.e., x = ( i = 1 n | x i | 2 ) 1 2 . Accordingly, the matrix norm is induced by Euclidean norm i.e., for a matrix A R m × n , A = max { λ i ( A H A ) } , where A H is the conjugate transpose of A and λ i ( A ) is the i-th eigenvalue of A . For a square matrix B R n × n , the expression B 0 means B is a negative definite matrix, while B 0 means B is a positive definite matrix. The symbol ⊗ denotes the Kronecker product, e.g., for matrix C R m × n , D R p × q ,
C D = c 11 D c 1 n D c m 1 D c m n D R m p × n q ,
where c i j is the i j -th element of C .

3.2. Graph Theory

We use an undirected graph G = ( V , E ) to describe the interactions among a group of n fixed-wing UAVs, where V = 1 , , n is a node set, E V × V is a set of ordered pairs of nodes, called edges. The adjacency matrix A = [ a i j ] n × n is defined as a i i = 0 and a i j = a j i = 1 if there is an edge between node i and node j. Diagonal matrix D = d i a g d 11 , d 22 , , d n n is the degree matrix of G , where the element of d i i = j = 1 n a i j . The Laplacian matrix of the graph G is defined as L = D A . Without loss of generality, the UAVs are denoted by nodes 1 , 2 , , n , and the target vehicle is denoted by node 0. We use another diagonal matrix B = d i a g b 11 , b 22 , , b n n to describe the connection between the i-th UAV and the target vehicle, where b i i > 0 if the state of the target is available to the i-th UAV and b i i = 0 otherwise.
The following assumption is made on digraph G .
Assumption 1.
The undirected graph G is connected and there exists at least one UAV that can obtains the state of the target.
Based on the Assumption 1, there are two important lemmas as follows
Lemma 1.
Let L = ( l i j ) R n × n be a Laplacian matrix of a connected undirected graph. Then the matrix
L ˜ = L + B = l 11 + b 11 l 1 n l n 1 l n n + b n n ,
is positive definite, if there exists an i such that b i i > 0 .
Proof of Lemma 1.
For z R n { 0 } , one can obtain that z T L ˜ z = z T L z + z T B z 0 , since L and B are both positive semi-definite. When z T L z = 0 , one can obtain that z s p a n 1 \ { 0 } , and z T B z > 0 . Thus, we always have z T L ˜ z > 0 for z 0 , which implies the conclusion. □
Lemma 2.
Let L ˜ R n × n be a positive definite and symmetric matrix. Then the matrix
M = 0 I n β 1 L ˜ β 2 L ˜ R 2 n × 2 n ,
is negative definite, where β 1 , β 2 > 0 .
Proof of Lemma 2.
To prove that M 0 , we can solve the equation det ( λ I 2 n M ) = 0 , where det ( λ I 2 n M ) is the characteristic polynomial of matrix M . Please note that
det λ I 2 n M = det λ I n I n β 1 L ˜ λ I n + β 2 L ˜ = det 0 I n λ 2 I n + β 1 + β 2 λ L ˜ λ I n + β 2 L ˜ = det λ 2 I n + β 1 + β 2 λ L ˜ ,
Additionally note that the eigenvalues of L ˜ satisfy the following property
det λ I 2 n + L ˜ = i = 1 n λ + ρ i
where ρ i is the i-th eigenvalues of L ˜ . Comparing Equation (3) and Equation (4), one can obtain that [32]
det λ 2 I n + β 1 + β 2 λ L ˜ = i = 1 n λ 2 + β 1 + β 2 λ ρ i
which implies that the roots of Equation (3) can be found by solving λ 2 + β 1 + β 2 λ ρ i = 0 . Thus, the eigenvalues of M are given by
λ i ± = β 2 ρ i ± β 2 2 ρ i 2 4 β 1 ρ i 2
Since L ˜ 0 , one can obtain that ρ i > 0 , it is easy to prove that every eigenvalue of L ˜ has negative real parts when β 1 , β 2 > 0 . Thus, M 0 . □

3.3. Gaussian Process Regression

For the learning of an unknown function f ( · ) , we need an oracle to predict the value of f ( x ) for a given input x X . In this paper, we use gaussian process as oracle which is a nonparametric model.
Definition 1
([33]). A gaussian process is a collection of random variables, any finite number of which have a joint Gaussian distribution.
Compared with other machine learning methods, GP does not only provide a prediction but also a prediction variance, an effective measure of the uncertainty of the learned model.
A GP is used to describe a distribution over functions, which can be written as
f ( x ) G P m ( x ) , k x , x ,
where m ( x ) : X R is the prior mean function, which allows the inclusion of prior knowledge about the unknown function f ( x ) and is often set to zero if there do not have any prior knowledge, and k ( x , x ) : X × X R 0 , + is the covariance function, which is associated with abstract concepts of function f ( x ) such as smoothness. Since the choice of kernel function is beyond the research of this paper, we choose squared exponential kernel typically as kernel function
k ( x , x ) = σ f 2 exp 1 2 ( x x ) Ω 1 ( x x ) ,
where σ f 0 , Ω = d i a g { l 1 2 , l 2 2 , , l n 2 } , l i 0 are hyperparameters.
To explain the process of GP regression, we assume a training data set D = X , Y consisting of training inputs X = x ( 1 ) , x ( 2 ) , , x ( M ) and training outputs Y = y ( 1 ) , y ( 2 ) , , y ( M ) , which consists of noisy observations y ( i ) = f ( x ( i ) ) + ς , where i = 1 , , M , of an unknown function f ( · ) perturbed by Measurement noise ς .
Assumption 2.
The unknown function f ( · ) is a sample from a Gaussian process G P ( 0 , k ( x , x ) ) and observations y ( i ) = f ( x ( i ) ) + ς are perturbed by zero mean i.i.d. Gaussian noise ς with variance σ 0 2 , i.e., ς N ( 0 , σ 0 2 ) .
Based on Assumption 2, the evaluations of y * at a given test input x * is again a Gaussian distribution with the posterior mean and variance
μ ( y * | x * , D ) = k ( x * ) K ( X ) + σ 0 2 I N 1 Y ,
σ 2 ( y * | x * , D ) = k ( x * , x * ) k ( x * ) K ( X ) + σ 0 2 I N 1 k ( x * ) ,
where the elements of k ( x * ) R M and K ( X ) R M × M are defined through k i ( x * ) = k ( x * , X ( i ) ) and K i i ( X ) = k ( X ( i ) , X ( i ) ) , respectively.
To capture the uncertainty of prediction, Yang et al. [17] made the following assumption, and put forward Lemma 3.
Assumption 3.
The continuous function f ( x ) is Lipschitz in x with Lipschitz constant L f to be a sample obtained from a Gaussian process G P ( 0 , k ( x , x ) ) with Lipschitz continuous kernel k : X × X R 0 , + .
Lemma 3
([17]). For any compact set X R m and a probability δ ( 0 , 1 ) , consider the unknown function f : X R , which satisfies Assumption 3, the estimation error Δ τ x of the posterior mean function conditioned on the training data D = X , Y is bounded with a certain probability.
P Δ τ x = f x μ x β ( ρ , δ ) σ x + γ ( ρ ) , x X 1 δ ,
where
β ( ρ , δ ) = 2 m log r Ω m 2 ρ + 2 log ( n ) 2 log ( δ ) ,
γ ( ρ ) = L f + L μ ρ + β ( ρ , δ ) L σ 2 ρ ,
where ρ R + are selected constant, r Ω = max x , x X x x , L μ and L σ 2 are the Lipschitz constants of the individual GP mean and variance functions, respectively.

4. Problem Formulation

In this section, we consider the corporative tracking control problem of a group of n fixed-wing UAVs with uncertain dynamics under bounded disturbance.

4.1. Models of Fixed-Wing UAVs

To simplify the dynamic model of UAV, we assume that each UAV flies at the predefined height, then the dynamics of the i-th UAV is described as
x ˙ i = υ i cos θ i y ˙ i = υ i sin θ i υ ˙ i = a i + f i 1 ( υ i , θ i ) + d i 1 θ ˙ i = ω i + f i 2 ( υ i , θ i ) + d i 2
where ( x i , y i ) represents the position of UAV i under initial frame, υ i and θ ˙ i are linear velocity and angular speed of UAV i, respectively, u i = a i , ω i is the control input, f i = f i 1 , f i 2 is the unknown dynamics of UAV i, and d i = d i 1 , d i 2 is the unknown disturbance, which is bounded, i.e., d i d .
Remark 1.
The unknown dynamics illustrate the model deviation relative to the nominal system. The function f i is unknown but the function value f i ( υ i * , θ i * ) can be measured. However, the external disturbance changes in different environment, which requires the robustness of the control law designed.
Define ξ i = x i , y i , ζ i = x ˙ i , y ˙ i , then Equation (14) can be transferred into state function
ξ ˙ i = ζ i ζ ˙ i = G i u i + f i + d i
where
G i = cos θ i υ i sin θ i sin θ i υ i cos θ i .
It is obvious that the matrix G i is full rank, and G i = max 1 , υ i .

4.2. Definition of Consensus Tracking Errors

We first define the dynamics of the target vehicle, which can be seen as the leader of the UAVs.
ξ ˙ 0 = ζ 0 ζ ˙ 0 = f 0 ( t )
where ξ 0 = x 0 , y 0 , ζ 0 = x ˙ 0 , y ˙ 0 , f 0 ( t ) are the position, velocity and acceleration of the target vehicle, respectively.
We define the tracking error between the target and i-th UAV to be
e i = ξ i ξ 0 ξ i 0 ,
where ξ i 0 = ( x i 0 , y i 0 ) is the predefined position from UAV i to the target. Then the error dynamic of i-th UAV is obtained as follows
e ˙ i = ζ i ζ 0 e ¨ i = G i u i + f i + d i f 0
To achieve the formation of UAVs with the consensus protocol, we define the consensus tracking error for each UAV to be
ε i = j = 1 n a i j ξ i ξ j ξ i j + b i i ξ i ξ 0 ξ i 0 = j = 1 n a i j e i e j + b i i e i ,
where a i j is the i j -th entry of the adjacency matrix A of the communication graph among the UAVs, b i i is the i i -th entry of the diagonal matrix B , and ξ i j is the predefined position from UAV i to UAV j, which can be calculated by ξ i j = ξ i 0 ξ j 0 .
Control Problem: Consider a group of n UAVs with dynamics Equation (14) and the target vehicle Equation (16), a distributed control law is to be designed such that the consensus tracking error for each UAV converges to finite bounds with probability.

5. Main Results

In this section, we first present an offline regression for the unknown dynamics of UAVs and illustrate the uniform error bounds for GP regression. Then, a learning-based control law is designed such that the group of UAVs can track the target vehicle in the predefined formation. Finally, the stability and robustness of the system are analyzed.

5.1. Offline Regression for Unknown Dynamics of UAVs

As shown in Figure 1, the process of modeling unknown dynamics model is divided into two steps, including flight testing and model training. Flight testing is to collect enough data via designing maneuvers [12], while model training is to establish GP model. It is noting that f i 1 , f i 2 in the framework contains the disturbance, and we need to minimize it as much as possible.
Assume that we obtain the training data set D = X , Y through flight testing before learning unknown dynamic function f i = f i 1 , f i 2 of i-th UAV, where X = ( υ i , θ i ) ( 1 ) , ( υ i , θ i ) ( 2 ) , , ( υ i , θ i ) ( M ) , Y = f i ( 1 ) , f i ( 2 ) , , f i ( M ) . Based on the data set, we choose Equation (8) as kernel function. According to Bayesian principles, the optimal hyperparameters to the observed data are obtained by maximizing the likelihood [34]
ψ * = arg max ψ log p Y X , ψ , log p Y X , ψ = 1 2 Y T K Y log det K M log ( 2 π ) .
where ψ is the set of hyperparameters which need to be optimized.
Then we can make use of Equation (9) to obtain posterior mean function μ i k υ i , θ i , k = 1 , 2 , which is the prediction value of f i k υ i , θ i .
Under Assumption 2 and Assumption 3, one can obtain that the estimation error of f i k υ i , θ i is limited in a certain bound with probability 1 δ
P Δ τ i k = f i k v i , θ i μ i k v i , θ i β i k ( ρ , δ ) σ i k v i , θ i + γ i k ( ρ ) , v i , θ i T X 1 δ ,
which is the basis of design of robust control law, and provides a premise for the proof of stability. Figure 2 illustrates the flowchart of the GP regression and its application.

5.2. Learning-Based Control Law

Assume that the acceleration of the target is available to each UAV, we design the distributed learning control law as follows
u i = μ i + G i 1 k 1 j = 1 n a i j e i e j + b i i e i k 2 j = 1 n a i j e ˙ i e ˙ j + b i i e ˙ i + f 0 ,
where k 1 , k 2 > 0 are constants, μ i = μ i 1 , μ i 2 is the posterior mean function of unknown dynamic function f i = f i 1 , f i 2 based on GP regression. Then theorem 1 will show the main result in this paper.
Theorem 1.
Consider a group of n UAVs with dynamics Equation (14) and the target vehicle Equation (16), a distributed control law Equation (21) employing predictions based on GP, will make the consensus tracking error Equation (19) of each UAV converge to certain bound with probability.
Proof of Theorem 1.
The second time derivative of the consensus tracking error ε i along Equation (18) is
ε ¨ i = j = 1 n a i j e ¨ i e ¨ j + b i i e ¨ i = j = 1 n a i j G i u i + f i + d i G j u j + f j + d j + b i i G i u i + f i + d i f 0 .
Define η 1 = ε 1 , ε 2 , ε n R 2 n , η 2 = ε ˙ 1 , ε ˙ 2 , ε ˙ n R 2 n , and substitute Equation (21) into Equation (22), we can rewrite Equation (22) as
ε ¨ i = j = 1 n a i j k 1 ε i ε j k 2 ε ˙ i ε ˙ j + b i i k 1 ε i k 2 ε ˙ i + j = 1 n a i j G i f i μ i G j f j μ j + G i d i G j d j + b i i G i f i μ i G j f j μ j + G i d i G j d j k 1 L ˜ i I 2 η 1 k 2 L ˜ i I 2 η 2 + L ˜ i I 2 Δ + L ˜ i I 2 H ,
where L ˜ i is the i-th row of L ˜ , and
Δ = G 1 f 1 G 1 μ 1 , G 2 f 2 G 2 μ 2 , G n f n G n μ n , H = G 1 d 1 , G 2 d 2 , G n d n .
Then we can obtain the differential function of the consensus tracking error:
η ˙ 1 η ˙ 2 = 0 I n I 2 k 1 L ˜ I 2 k 2 L ˜ I 2 η 1 η 2 + 0 L ˜ I 2 Δ + L ˜ I 2 H .
Based on Lemmas 1 and 2, the state matrix
S 0 I n I 2 k 1 L ˜ I 2 k 2 L ˜ I 2 = 0 I n k 1 L ˜ k 2 L ˜ I 2 0 .
Define η = η 1 , η 2 and Θ = 0 L ˜ I 2 Δ + L ˜ I 2 H , one can obtain that
Θ 2 L ˜ i = 1 n G i ( Δ τ i + d i )
Since disturbance d i is bounded and estimation error Δ τ i ( Δ τ i 1 , Δ τ i 2 ) is bounded with probability ( 1 δ ) 2 , Θ is bounded with probability.
Consider a candidate Lyapunov function:
V = 1 2 η η .
The time derivative of V along Equation (24) is
V ˙ = η S η + Θ .
Define λ max as the largest eigenvalue of the matrix S . Since S 0 , λ max < 0 , there exists a constant, κ > 0 , that makes λ max < κ 2 < 0 .
Then, one can obtain that
V ˙ = η ( S η + Θ ) λ max + κ 2 η η κ 2 η η + η Θ = λ max + κ 2 η η κ η 1 2 Θ κ 2 + 1 4 Θ 2 κ 2 λ max + κ 2 η 2 + 1 4 Θ 2 κ 2 = 2 λ max + κ 2 V + 1 4 Θ 2 κ 2 .
Since λ max + κ 2 < 0 , η will converge to a certain bound exponentially with probability, and the bound of η is Θ κ 2 λ max + κ 2 . □
Remark 2.
If there exists a data set D e n d , such that the estimation error P f e n d μ = 0 1 δ , ( 0 < δ < 1 ) [35], and the energy of disturbance is bounded, i.e., 0 T H 2 d t < c , η will converge to zero asymptotically.
Remark 3.
If the acceleration of the target is not available, the element f 0 in the control law Equation (21) will be eliminated [36]. It can be considered to be the bounded disturbance and the stability analysis is the same as the Theorem 1.

6. Simulation Results

In this section, we consider a simulation scenario that four UAVs track the target vehicle in the predefined formation. The simulation is carried out on a personal computer, which has 6 CPU cores (Intel(R) Core(TM) i7-10750H CPU @ 2.60GHz), and the simulation environment is Matlab2020a. fitrap function is used for Gaussian process regression.
The unknown parts of dynamic function are given as follows
f i 1 υ i , θ i = 0.0035 | υ i 13 | exp ( 0.8 υ i ) , f i 2 υ i , θ i = 0.04 υ i sin 3 θ i + ln υ i υ i 1.5 cos 2 θ i ,
where i = 1 , 2 , 3 , 4 . The 2500 training inputs are equally distributed on the set [ 8 , 20 ] × [ π , π ] , since the velocity of the UAV is subject to some constraints. The labels in the training pairs are the observed value of Equation (29) with Gaussian noise ς , ς N ( 0 , 0.03 ) .
The parts of disturbance, d i 1 and d i 2 , are given as the white noise and bounded noise, respectively, which account for 2 % of control input. The trajectory of the target vehicle is given as follows
x 0 ( t ) = 200 cos 0.07 t , y 0 ( t ) = 150 sin 0.07 t ,
where ( x 0 , y 0 ) is the position of the target vehicle.
Figure 3 shows interactions among the UAVs and the target vehicle, which is chosen under Assumption 1. The control gains are chosen to be k 1 = 1.5 , k 2 = 0.5 , the diagonal matrix B = d i a g { 1 , 1 , 0 , 0 } , the adjacency matrix A and matrix L ˜ are given as follows
A = 0 1 0 1 1 0 1 0 0 1 0 1 1 0 1 0 ,                     L ˜ = 3 1 0 1 1 3 1 0 0 1 2 1 1 0 1 2 .
The whole simulation lasts for 200 seconds, during the simulation, the estimation error of GP model is bounded, which can be seen in Figure 4. It is noting that Gaussian noise ς is of great importance in the data learning of GP model, since too much noise would reduce the reliability of the training data.
To visually demonstrate the tracking performance, Figure 5 shows the trajectory of four UAVs and the target in the three-dimensional plots, where all UAVs track the target vehicle in the predefined formation. Figure 6 illustrates the consensus tracking error of each UAV, which is defined in Equation (19). It is noting that the consensus tracking error of each UAV converges to a certain bound exponentially and the final bounds of error in two directions are 1 m.
To show the effectiveness of the proposed method, we consider the other three cases, which include the case based on NNs model, based on polynomial model and based on nominal model. We employ a two-layer feed-forward network via Neural Net Fitting APP in Matlab to train NNs model of unknown dynamic, and the number of hidden neurons is 5 in the training. The polynomial model is trained via Curve Fitting APP in Matlab, and the degree of the polynomial is 3. Table 1 demonstrates the RMSE of three models, among which the RMSE of GP model is minimal. Figure 7 shows the accumulated consensus tracking errors of 4 UAVs, which are defined as i = 1 4 ε i , j , where j = 1 , 2 denotes two directions. We can find that the tracking performance based on GP model and NNs model are almost the same, which are better than that based on polynomial model. The performance based on nominal model, without considering uncertainty, is the worst. Although the performance based on GP model and NNs model are almost the same, the uniform error of GP model can be explained based on Lemma 3.

7. Conclusions and Future Work

In this paper, we study a tracking problem of fixed-wing UAVs with uncertain dynamic. A group of UAVs needs to track the target vehicle in a predefined formation. We first establish the data-driven model for uncertain dynamic with the technique of Gaussian process regression. With the help of the main theorem proposed by Armin Lederer [17], the uniform error of the model is guaranteed to be bounded with a high probability. Then, we design a consensus protocol for the tracking control of multi-UAVs, where the bounded disturbance is considered. The stability of the system is proven via Lyapunov analysis, and the tracking error is guaranteed to be uniform bounded with a high probability. Finally, we carry out the numerical simulation. In the simulation scenario, we compare four cases, including the case based on NNs model, based on polynomial model and based on nominal model. The results demonstrate that the proposed method is effective and robust.

Author Contributions

Conceptualization, Q.W.; Data curation, Q.W.; Formal analysis, Q.W.; Investigation, Q.W.; Methodology, Q.W.; Project administration, S.Z. and X.W.; Writing—original draft, Q.W.; Writing—review & editing, S.Z. and X.W. All authors have read and agreed to the published version of the manuscript.

Funding

No funding.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Acknowledgments

This study is a part of the M.S. research of the corresponding author. We are grateful to anonymous reviewers and editors for their suggestions.

Conflicts of Interest

The authors declare no conflict of interest.

Nomenclature

The following abbreviations are used in this manuscript:
x i x position of i-th UAV in the inertial frame
y i y position of i-th UAV in the inertial frame
x 0 x position of the target in the inertial frame
y 0 y position of the target in the inertial frame
θ i heading angle of i-th UAV in the inertial frame
υ i velocity of i-th UAV in the inertial frame
G undirected graph to describe the interactions among UAVs
GPGaussian process
GPRGaussian process regression
NNsneural networks
UAVunmanned aerial vehicle
DOFdegree of freedom
MASmulti-agent systems
RMSEroot mean squared error

References

  1. Wang, X.; Shen, L.; Liu, Z.; Zhao, S.; Cong, Y.; Li, Z.; Jia, S.; Chen, H.; Yu, Y.; Chang, Y.; et al. Coordinated flight control of miniature fixed-wing UAV swarms: Methods and experiments. Sci. China Inf. Sci. 2019, 62, 1–17. [Google Scholar] [CrossRef] [Green Version]
  2. Wang, X.; Zeng, Z.; Cong, Y. Multi-agent distributed coordination control: Developments and directions via graph viewpoint. Neurocomputing 2016, 199, 204–218. [Google Scholar] [CrossRef]
  3. Nichols, J.W.; Sun, L.; Beard, R.W.; McLain, T. Aerial rendezvous of small unmanned aircraft using a passive towed cable system. J. Guid. Control Dyn. 2014, 37, 1131–1142. [Google Scholar] [CrossRef] [Green Version]
  4. Lellis, E.D.; Vito, V.D.; Ruby, M.; Salbego, N. Adaptive Algorithm for Fixed Wing Uav Autolanding on Aircraft Carrier, AIAA. 2013. Available online: https://arc.aiaa.org/doi/abs/10.2514/6.2013-4585 (accessed on 15 August 2013).
  5. Zhao, S.; Wang, X.; Chen, H.; Wang, Y. Cooperative Path Following Control of Fixed-wing Unmanned Aerial Vehicles with Collision Avoidance. J. Intell. Robot. Syst. 2020, 100, 1569–1581. [Google Scholar] [CrossRef]
  6. Gerardo, F.; Alejandro, F.; Andre, M. A full controller for a fixed-wing UAV. arXiv 2019, arXiv:1903.03945. Available online: https://arxiv.org/abs/1903.03945 (accessed on 10 March 2019).
  7. Su, C.; Wang, X.; Shen, L.; Yu, H. Adaptive uav maneuvering control system based on dynamic inversion and long-short-term memory network. In Proceedings of the 2020 Chinese Automation Congress (CAC), Shanghai, China, 6–8 November 2020; pp. 6880–6885. [Google Scholar]
  8. Ghommam, J.; Saad, M. Coordinated 3d path following control for a team of uavs with reference velocity recovery. In Proceedings of the 2009 European Control Conference (ECC), Budapest, Hungary, 23–26 August 2009; pp. 3008–3014. [Google Scholar]
  9. Tang, Y.; Lin, D.; Cao, L.J.; Liu, Y.C. Attitude Control of Fixed-Wing UAV Under Model Uncertainty and Disturbances. Electron. Opt. Control 2020, 27, 85–89. [Google Scholar]
  10. Roza, A.; Maggiore, M.; Scardovi, L. A smooth distributed feedback for formation control of unicycles. IEEE Trans. Autom. Control 2019, 64, 4998–5011. [Google Scholar] [CrossRef]
  11. Seyboth, G.S.; Wu, J.; Qin, J.; Yu, C.; Allgower, F. Collective circular motion of unicycle type vehicles with nonidentical constant velocities. IEEE Trans. Control Netw. Syst. 2014, 1, 167–176. [Google Scholar] [CrossRef]
  12. Hemakumara, P.; Sukkarieh, S. Non-parametric uav system identification with dependent gaussian processes. In Proceedings of the 2011 IEEE International Conference on Robotics and Automation, Shanghai, China, 9–13 May 2011; pp. 4435–4441. [Google Scholar]
  13. Beckers, T.; Umlauft, J.; Hirche, S. Stable model-based control with gaussian process regression for robot manipulators. IFAC-PapersOnLine 2017, 50, 3877–3884. [Google Scholar] [CrossRef]
  14. Maiworm, M.; Limon, D.; Findeisen, R. Online learning-based model predictive control with gaussian process models and stability guarantees. Int. J. Robust Nonlinear Control 2021. Available online: https://doi.org/10.1002/rnc.5361 (accessed on 27 September 2021).
  15. Deisenroth, M.P.; Fox, D.; Rasmussen, C.E. Gaussian processes for data-efficient learning in robotics and contro. IEEE Trans. Pattern Anal. Mach. Intell. 2015, 37, 408–423. [Google Scholar] [CrossRef] [Green Version]
  16. Srinivas, N.; Krause, A.; Kakade, S.M.; Seeger, M.W. Information-theoretic regret bounds for gaussian process optimization in the bandit setting. IEEE Trans. Inf. Theory 2012, 58, 3250–3265. [Google Scholar] [CrossRef] [Green Version]
  17. Lederer, A.; Umlauft, J.; Hirche, S. Uniform error bounds for gaussian process regression with application to safe control. In Proceedings of the 33rd Annual Conference on Neural Information Processing Systems, Vancouver, BC, Canada, 8–14 December 2019. [Google Scholar]
  18. Yang, Z.; Sosnowski, S.; Liu, Q.; Jiao, J.; Lederer, A.; Hirche, S. Distributed learning consensus control for unknown nonlinear multi-agent systems based on gaussian processes. arXiv 2021, arXiv:2103.15929. Available online: https://arxiv.org/abs/2103.15929 (accessed on 27 September 2021).
  19. O’Callaghan, S.; Ramos, F.T.; Durrant-Whyte, H. Contextual Occupancy Maps using Gaussian Processes. In Proceedings of the 2009 IEEE International Conference on Robotics and Automation, Kobe, Japan, 12–17 May 2009. [Google Scholar]
  20. Khansari-Zadeh; Kim, H.J.; Johansson, K.H. Path planning for remotely controlled UAVs using Gaussian process filter. In Proceedings of the 2017 17th International Conference on Control, Automation and Systems (ICCAS 2017), Jeju, Korea, 18–21 October 2017. [Google Scholar]
  21. Cai, L.; Liu, X.; Ding, H.; Chen, F. Human Action Recognition Using Improved Sparse Gaussian Process Latent Variable Model and Hidden Conditional Random Filed. IEEE Access 2018, 6, 20047–20057. [Google Scholar] [CrossRef]
  22. Ghasrodashti, E.K.; Helfroush, M.S.; Danyali, H. Sparse-Based Classification of Hyperspectral Images Using Extended Hidden Markov Random Fields. IEEE J. Sel. Top. Appl. Earth Obs. Remote Sens. 2018, 11, 4101–4112. [Google Scholar] [CrossRef]
  23. Kordi Ghasrodashti, E.; Helfroush, M.S.; Danyali, H. Spectral-spatial classification of hyperspectral images using wavelet transform and hidden Markov random fields. Geocarto Int. 2018, 33, 771–790. [Google Scholar] [CrossRef]
  24. Lee, J.; Muskardin, T.; Paez, C.R.; Oettershagen, P.; Stastny, T.; Sa, I. Roland Siegwart and Konstantin Kondak, Towards Autonomous Stratospheric Flight: A Generic Global System Identification Framework for Fixed-Wing Platforms. In Proceedings of the 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain, 1–5 October 2018. [Google Scholar]
  25. Yoo, J.; Mohammad, S.; Billard, A. Learning Stable Nonlinear Dynamical Systems With Gaussian Mixture Models. IEEE Trans. Robot. 2011, 27, 943–957. [Google Scholar]
  26. Hemakumara, P.; Sukkarieh, S. Learning UAV Stability and Control Derivatives Using Gaussian Processes. IEEE Trans. Robot. 2013, 29, 813–824. [Google Scholar] [CrossRef]
  27. Park, S.; Mustafa, S.K.; Shimada, K. Learning-Based Robot Control with Localized Sparse Online Gaussian Process. In Proceedings of the 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Tokyo, Japan, 3–7 November 2013. [Google Scholar]
  28. Umlauft, J.; Pohler, L.; Hirche, S. An uncertainty-based control lyapunov approach for control-affine systems modeled by gaussian process. IEEE Control Syst. Lett. 2018, 2, 483–488. [Google Scholar] [CrossRef]
  29. Maiworm, M.; Limon, D.; Manzano, J.M.; Findeisen, R. Stability of gaussian process learning based output feedback model predictive control. In Proceedings of the 6th IFAC Conference on Nonlinear Model Predictive Control NMPC 2018, Madison, WI, USA, 19–22 August 2018; pp. 455–461. [Google Scholar]
  30. Wang, P.; Luo, Y.; Yu, J.J. Coordinated Formation for multiple UAVs Based on H∞ Control, 2020. (In Chinese). Available online: http://qikan.cqvip.com/Qikan/Article/Detail?id=7102783600 (accessed on 27 September 2021).
  31. Defoort, M.; Floquet, T.; Kokosy, A.; Perruquetti, W. Sliding-Mode Formation Control for Cooperative Autonomous Mobile Robots. IEEE Trans. Ind. Electron. 2008, 55, 3944–3953. [Google Scholar] [CrossRef] [Green Version]
  32. Ren, W.; Atkins, E. Distributed multi-vehicle coordinated controlvia local information exchange. Int. J. Robust Nonlinear Control 2007, 17, 1002–1033. [Google Scholar] [CrossRef] [Green Version]
  33. Rasmussen, C.E.; Williams, C.K.I. Gaussian Processes for Machine Learning; The MIT Press: Cambridge, MA, USA, 2006. [Google Scholar]
  34. Umlauft, J.; Beckers, T.; Kimmel, M.; Hirche, S. Feedback linearization using gaussian processes. In Proceedings of the 2017 IEEE 56th Annual Conference on Decision and Control (CDC), Melbourne, Australia, 12–15 December 2017; pp. 5249–5255. [Google Scholar]
  35. Beckers, T.; Colombo, L.; Hirche, S. Online learning-based trajectory tracking for underactuated vehicles with uncertain dynamics. arXiv 2020. Available online: https://arxiv.org/abs/2009.06689 (accessed on 27 September 2021).
  36. Ren, W. Consensus strategies for cooperative control of vehicle formations. IET Control Theory Appl. 2007, 1, 505–512. [Google Scholar] [CrossRef]
Figure 1. The framework of the process of modeling unknown dynamics model.
Figure 1. The framework of the process of modeling unknown dynamics model.
Applsci 11 09830 g001
Figure 2. The flowchart of GP regression and its application.
Figure 2. The flowchart of GP regression and its application.
Applsci 11 09830 g002
Figure 3. The communication graph of the vehicles.
Figure 3. The communication graph of the vehicles.
Applsci 11 09830 g003
Figure 4. Estimation error of GP model.
Figure 4. Estimation error of GP model.
Applsci 11 09830 g004
Figure 5. Trajectories of 4 UAVs and Target vehicle.
Figure 5. Trajectories of 4 UAVs and Target vehicle.
Applsci 11 09830 g005
Figure 6. Consensus tracking error of four UAVs.
Figure 6. Consensus tracking error of four UAVs.
Applsci 11 09830 g006
Figure 7. Accumulated consensus tracking errors of 4 UAVs.
Figure 7. Accumulated consensus tracking errors of 4 UAVs.
Applsci 11 09830 g007
Table 1. The RMSE of three models.
Table 1. The RMSE of three models.
  f i 1 f i 2
GP model 0.0285 1.2407 e 04
NNs model 0.0471 0.0232
Polynomial model 0.05425 0.9851
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Wang, Q.; Zhao, S.; Wang, X. Distributed Control for Coordinated Tracking of Fixed-Wing Unmanned Aerial Vehicles under Model Uncertainty and Disturbances. Appl. Sci. 2021, 11, 9830. https://doi.org/10.3390/app11219830

AMA Style

Wang Q, Zhao S, Wang X. Distributed Control for Coordinated Tracking of Fixed-Wing Unmanned Aerial Vehicles under Model Uncertainty and Disturbances. Applied Sciences. 2021; 11(21):9830. https://doi.org/10.3390/app11219830

Chicago/Turabian Style

Wang, Qipeng, Shulong Zhao, and Xiangke Wang. 2021. "Distributed Control for Coordinated Tracking of Fixed-Wing Unmanned Aerial Vehicles under Model Uncertainty and Disturbances" Applied Sciences 11, no. 21: 9830. https://doi.org/10.3390/app11219830

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