Next Article in Journal
A Review on Software-Based and Hardware-Based Authentication Mechanisms for the Internet of Drones
Next Article in Special Issue
Thrust Vector Observation for Force Feedback-Controlled UAVs
Previous Article in Journal
Drones in B5G/6G Networks as Flying Base Stations
Previous Article in Special Issue
Distributed 3D Navigation of Swarms of Non-Holonomic UAVs for Coverage of Unsteady Environmental Boundaries
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Robust Hierarchical Formation Control of Unmanned Aerial Vehicles via Neural-Based Observers

School of Electrical and Electronic Engineering, The University of Adelaide, North Terrace, Adelaide 5000, Australia
*
Author to whom correspondence should be addressed.
Drones 2022, 6(2), 40; https://doi.org/10.3390/drones6020040
Submission received: 17 January 2022 / Revised: 1 February 2022 / Accepted: 1 February 2022 / Published: 6 February 2022
(This article belongs to the Special Issue Conceptual Design, Modeling, and Control Strategies of Drones)

Abstract

:
Herein, we investigate the robust formation control problem for a group of unmanned aerial vehicles (UAVs) with system uncertainty. A hierarchical formation control strategy is introduced to ensure the uniform ultimate boundedness of each UAV’s reference tracking error. First, a group of saturated high-level virtual agents are defined to act as the trajectory planners that offer feasible position references to the actual UAVs. A sliding mode neural-based observer is then constructed to estimate the nonlinear uncertainty in the UAV model. Furthermore, sliding mode controllers are designed for both the position loop and the attitude loop of the UAV. To attenuate the chattering phenomenon in the control input, a saturated and smoothed differentiator is proposed along with an observation introduction function. The effectiveness of the proposed control scheme is validated by both the Lyapunov stability theory and numerical simulations based on a multiple-UAV system.

1. Introduction

In recent years, the concept of multi-agent systems [1,2,3,4,5] was developed after the limitations of using single robot were found in various practical scenarios. Along with consensus theory [6] and swarm behaviour [7,8], formation control [9,10,11,12] have become an attractive research topic because of its close connection with tasks such as transportation [13] and surveillance. Compared to unmanned ground vehicles (UGVs) [14], UAVs [15,16,17,18,19,20] are more popular because they possess higher degrees of freedom.
In [16], the time-varying formation tracking problem for a multiple-UAV system subjected to switching communication topologies is investigated by solving an algebraic Riccati equation. Similar results were found for the time-varying formation-containment control problem in [21]. Although the results presented in [16,21] can illustrate the uniform ultimate boundedness of formation tracking errors, the corresponding designs were based on the ideal homogeneous second-order dynamics, which are only applicable in the high-level path planning perspective, not low-level motion controller design.
Based on the nonlinear cascade model presented in [22], a finite-time leader–follower formation tracking scheme was proposed in [23] for a group of UAVs with undirected topologies. Furthermore, a heterogeneous multi-robot system that includes both UAVs and UGVs was analysed in [24], and a neural-based fault tolerant formation controller was introduced to perform adaptive formation tracking. However, neither of the above two works included the path planning module for UAVs, leading to rapid and excessive changes in the angular status, which is also referred to as aggressive flight [25]. Hence, it is necessary to develop a path planning scheme that offers smooth and suitable reference states to the formation controller to reduce the frequency of aggressive motions.
Model uncertainty and external disturbance are also essential factors to consider for practical applications [26,27,28]. Regarding nonlinear systems with model switching phenomena because of the linearisation operation, the methods that are based on the linear parameter varying modelling theory are helpful for maintaining the robustness of the controller design [29,30,31]. Alternatively, building up nonlinear adaptive observers is necessary to compensate for the system uncertainty if we choose to analyse a system without linearisation. An adaptive terminal sliding mode observer was introduced in [32] to estimate the system uncertainties within finite time. Although the observer given in [32] was found to be effective, this was based on the assumption of correlation with the uncertainty’s Lipschitz constant.
Compared to the conventional adaptive observers [33], the neural-based observer presented in [34] has less constraints for the system uncertainty and is more adaptive. The structure in [34] was further modified in [35] to estimate the unknown velocity and the system uncertainty simultaneously for second-order systems. However, the designs in [34] and [35] both use the proportional error reduction term, which makes it hard to guarantee fast convergence of observer states. Therefore, whether we can integrate the neural-based design in [34] with the sliding mode technique in the conventional observer design is a topic worthy of discussion.
Due to the special cascading relationship between a UAV’s position loop and attitude loop, the motion controller of a UAV is usually designed in a two-loop structure [15] that requires using the virtual control input in the position loop to get the desired angular status through flight control algorithms. With a strong coupling relationship between the two loops, the control input is sensitive to the sudden changes in system states that can potentially lead to oscillation and chattering [32]. The work in [35] also pointed out that the neural network (NN) output is filled with chattering if the neural weight adjusting law is equipped with static parameters. Hence, it is necessary to find a method to attenuate the potential chattering phenomenon in the control input.
Based on our previous discussions, the contributions of this paper are listed as follows:
1.
Inspired by the work in [36], a hierarchical formation control scheme is employed in this paper. To make the reference provided by the high-level systems feasible for low-level UAVs, a saturated high-level formation controller is proposed to reduce the frequency of aggressive motion.
2.
To improve the error converging speed of the observer structure in [34], the sliding mode technique is integrated with an artificial NN to construct an adaptive observer to estimate the unknown nonlinearities in UAV dynamics, and a fully error-related update law is employed.
3.
To attenuate the chattering phenomenon in the control input [32], a saturated and smoothed differentiator is proposed along with an observation introduction function to reduce the oscillations caused by the differentiating process and the neural-based observer.
The article is structured as follows. The modelling of the multi-UAV system, the basics of graph theory and some background on artificial NN estimation are given in Section 2. The hierarchical formation control scheme and the sliding mode neural-based observer are presented in Section 3. The set-up, results and discussion regarding the numerical simulations of a group of UAVs are illustrated in Section 4. The conclusions are drawn in Section 5.
Notation: In this paper, the term ⊗ represents Kronecker production, I n denotes an identity matrix with the dimension of n. For a matrix M , M F represents its Frobenius norm. If M is a square matrix, we have σ ¯ ( M ) and σ ̲ ( M ) as the maximum and minimal eigenvalues of M , respectively.

2. Preliminaries

2.1. Dynamic Model of Uavs

Consider a distributed heterogeneous multi-drone system consists of N ( N > 1 ) UAVs, where the dynamics of the ith UAV is expressed as: [24]
p ¨ x i = K i , x m i p ˙ x i + cos ( ϕ i ) sin ( θ i ) cos ( ψ i ) + sin ( ϕ i ) sin ( ψ i ) m i ( u i , 1 + u i , 2 + u i , 3 + u i , 4 ) + w ¯ i , x p ¨ y i = K i , y m i p ˙ y i + cos ( ϕ i ) sin ( θ i ) sin ( ψ i ) sin ( ϕ i ) cos ( ψ i ) m i ( u i , 1 + u i , 2 + u i , 3 + u i , 4 ) + w ¯ i , y p ¨ z i = K i , z m i p ˙ z i g + cos ( ϕ i ) cos ( θ i ) m i ( u i , 1 + u i , 2 + u i , 3 + u i , 4 ) + w ¯ i , z ϕ ¨ i = K i , ϕ J i , x ϕ i ˙ + J i , y J i , z J i , x θ ˙ i ψ i ˙ + R i J i , x ( u i , 2 + u i , 4 ) + w ¯ i , ϕ θ i ¨ = K i , θ J i , y θ i ˙ + J i , z J i , x J i , y ϕ ˙ i ψ i ˙ + R i J i , y ( u i , 1 + u i , 3 ) + w ¯ i , θ ψ i ¨ = K i , ψ J i , z ψ i ˙ + J i , x J i , y J i , z ϕ ˙ i θ i ˙ + υ i J i , z ( u i , 1 + u i , 2 u i , 3 + u i , 4 ) + w ¯ i , ψ , i [ 1 , N ]
where p x i , p y i and p z i represent the global coordinates of the ith UAV; ϕ i , θ i and ψ i denote the roll angle, pitch angle and yaw angle, respectively; u i , j ( j [ 1 , 4 ] ) represents the combined thrust or force provided by the jth motor; R i is the distance between the centre of the drone and the centre of the rotor; and the rest of the parameters are defined in Table 1.
For the sake of simplicity, we make the following definitions to divide the control input of the system into T i , τ i , 1 , τ i , 2 and τ i , 3 :
T i = u i , 1 + u i , 2 + u i , 3 + u i , 4 , τ i , 1 = u i , 2 + u i , 4 τ i , 2 = u i , 1 + u i , 3 , τ i , 3 = u i , 1 + u i , 2 u i , 3 + u i , 4
Due to the strong coupling between channels, the position channel and the attitude channel should not be combined into an overall second-order model [23]. Instead, design and analysis based on individual loops are required. Define x i , p = [ p x i , p y i , p z i ] T and v i , p = [ p ˙ x i , p ˙ y i , p ˙ z i ] T . We then have the dynamics of the position loop as
x ˙ i , p = v i , p v ˙ i , p = f i , p + g i , p T i + w ¯ i , p g ¯ p , i [ 1 , N ]
for which we have the following equations:
f i , p = [ K i , x p ˙ x i / m i , K i , y p ˙ y i / m i , K i , z p ˙ z i / m i ] T , w ¯ i , p = [ w ¯ i , x , w ¯ i , y , w ¯ i , z ] T , g ¯ p = [ 0 , 0 , g ] T g i , p = cos ( ϕ i ) sin ( θ i ) cos ( ψ i ) + sin ( ϕ i ) sin ( ψ i ) m i cos ( ϕ i ) sin ( θ i ) sin ( ψ i ) sin ( ϕ i ) cos ( ψ i ) m i cos ( ϕ i ) cos ( θ i ) m i T
If we have w i , p = f i , p + w ¯ i , p as the overall system uncertainties in the position loop, Equation (3) can be simplified to the following version:
x ˙ i , p = v i , p v ˙ i , p = g i , p u i + w i , p , i [ 1 , N ]
Similarly, if we define x i , a = [ ϕ i , θ i , ψ i ] T and v i , a = [ ϕ ˙ i , θ ˙ i , ψ ˙ i ] T , then the dynamics in the attitude loop has the following expression:
x ˙ i , a = v i , a v ˙ i , a = g i , a τ i + w i , a , i [ 1 , N ]
where w i , a = f i , a + w ¯ i , a , w ¯ i , a = [ w ¯ i , ϕ , w ¯ i , θ , w ¯ i , ψ ] T and
f i , a = ( J i , y J i , z ) θ ˙ i ψ i ˙ / J i , x K i , ϕ ϕ i ˙ / J i , x ( J i , z J i , x ) ϕ ˙ i ψ i ˙ / J i , y K i , θ θ i ˙ / J i , y ( J i , x J i , y ) ϕ ˙ i θ i ˙ / J i , z K i , ψ ψ i ˙ / J i , z , g i , a = R i J i , x 0 0 0 R i J i , y 0 0 0 υ i J i , z , τ i = τ i , 1 τ i , 2 τ i , 3
For the sake of convenience while analysing the cluster formation tracking behaviour in later parts, it is still necessary to have a unified cluster dynamics expression. For the ith UAV, define x i = [ x i , p T , x i , a T ] T and v i = [ v i , p T , v i , a T ] T ; then, we have the following simplified version:
x ˙ i = v i v ˙ i = u i + w i g ¯ i , i [ 1 , N ]
where we have u i = [ ( g i , p T i ) T , ( g i , a τ i ) T ] T , w i = [ w i , p T , w i , a T ] T and g ¯ i = [ g ¯ p T , 0 , 0 , 0 ] T .
To obtain the cluster expression, we define x = [ x 1 T , x 2 T , , x N T ] T , v = [ v 1 T , v 2 T , , v N T ] T , u = [ u 1 T , u 2 T , , u N T ] T , w = [ w 1 T , w 2 T , , w N T ] T and g ¯ = [ g ¯ 1 T , g ¯ 2 T , , g ¯ N T ] , which further lead to
x ˙ = v s . v ˙ = u + w g ¯
Definition 1.
[37] Consider a vector X. We have a correlated continuous Lyapunov function V ( X ) . Then the vector X is said to be semi-globally uniformly ultimately bounded (SGUUB) if V ( X ) satisfies V ( X ) = 0 only when X = 0 , and there exists a positive boundary b X and a time t X ( X ( t 0 ) , b X ) such that V ( X ) b X for all t t X and X ( t 0 ) Ω X V , where t 0 is the initial time, X ( t 0 ) is the initial value of X and Ω X V is a compact set of X.
There are two sets of reference for each UAV to follow, the position reference and the attitude reference. Throughout this paper, we use x i , p d R 3 and ψ i d R 1 to represent the position reference and the desired yaw angle for the ith UAV, respectively. The goal of this article is to achieve semi-global uniform ultimate boundedness for each UAV’s position tracking error and attitude tracking error, which is illustrated as
lim t x i , p x i , p d μ p , lim t ψ i ψ i d μ a , x i ( t 0 ) Ω x
where both μ p and μ a are small positive constants, and Ω x is a compact set of x i .
The following assumptions are made for the system of Equation (7):
Assumption A1.
The trajectory reference x i , p d and its derivatives x ˙ i , p d and x ¨ i , p d are all bounded and accessible to the ith UAV. The yaw angle reference ψ i d is bounded and known to the ith UAV.

2.2. Graph Theory

In this paper, the distributed communication topology of the multi-UAV system is illustrated by a directed graph G = { R , E , A } , where R = { r 1 , r 2 , , r N } represents the set of nodes, E R × R stands for the set of edges and A = [ a i j ] R N × N is the adjacency matrix with nonnegative entries. An edge of the graph G is illustrated as e i j = ( r i , r j ) , which stands for edge points from node r i to node r j . Self-loops are not considered in this paper, and a j i = 1 if and only if e i j E . We define deg in ( r i ) = j = 1 N a i j to be the in-degree of the ith node, and the degree matrix of the graph is illustrated as D = diag { deg in ( r 1 ) , deg in ( r 2 ) , , deg in ( r N ) } . The Laplacian matrix of the graph is defined as L = D A . If there always exists a directed path between a pair of distinguished nodes, then the directed graph G is said to be strongly connected. The following lemma is useful for the stability analysis of the proposed control scheme.
Lemma 1.
[38] Let the graph G be strongly connected and B R n × n be a non-negative diagonal matrix with at least one positive element. The matrix ( L + B ) is considered as an irreducible nonsingular M-matrix. Define
q = [ q 1 q 2 q N ] T = ( L + B ) 1 1 N × 1 .
We then obtain that P = diag { p i } = diag { 1 / q i } is a positive definite matrix. Then the matrix Q defined as Q = P ( L + B ) + ( L + B ) T P is symmetric and positive definite.

2.3. Artificial Nn Approximation

In this study two-layer artificial NNs were employed to estimate the overall system uncertainty w i . According to the universal approximation theorem, a single-layer artificial NN can be used to approximate the unknown function whose variables are restricted to a compact set [39]. Hence, the uncertainty w i can be given in the following form:
w i = W i T φ ( x i , v i ) + ϵ i , x i Ω x , v i Ω v , i = 1 , 2 , , n
where φ ( · ) is the activation function vector of the NN, W i is the optimal weight matrix, ϵ i is the bounded network approximation bias that satisfies ϵ i ϵ M , ϵ M is a bounded positive number and Ω v is a compact set of v i . To reduce the complexity of the NN design, we chose the activation function as the identity function, which further leads to φ ( x i , v i ) = [ x i T , v i T ] T R 12 × 1 , W i R 12 × 6 and ϵ i R 6 .
For the ith UAV, the NN estimation of w i is given as:
w ^ i = W ^ i T φ ( x i , v i )
where W ^ i denotes the estimated weight matrix.
Define W ˜ i = W i W ^ i and w ˜ i = w i w ^ i . Then the estimation error w ˜ i is given as
w ˜ i = W ˜ i T φ ( x i , v i ) + ϵ i
The following assumption is made to ensure the boundedness of the NN output:
Assumption A2.
The optimal weight matrix W i is bounded such that W i F W M is met for each UAV, where W M is a positive constant.
Remark 1.
In a practical task, the external disturbance may include functions that do not use the system states x i and v i as variables. For example, the external disturbance w ¯ i can be a function that only relates to the task time t (such as w ¯ i = s i n ( t ) ). However, since the system states x i and v i are correlated with external variables such as t, and therefore can be expressed as a function whose variables include the external variables, the external variables can also be seen as a function that uses the system states x i and v i as its variables. Hence, we are still able to employ the NN to perform a unified estimation of w ¯ i , which validates the implementation of Equation (9).

3. Main Results

In this paper, the robust formation control problem of multi-UAV systems is considered, along with the collision avoidance issue when each UAV contains model uncertainty. To reduce the complexity of the controller design, we propose to use a hierarchical two-level formation controller design to separate the concerns.
In high-level designs, virtual agents are generated according to the second-order nominal model of UAVs to act as the reference generators that provide feasible commends to the low-level design, and the low-level controllers are responsible for the actual motion control of physical UAVs. A new neural-based observer design is also proposed in this section for the estimation and compensation of the nonlinear model uncertainties.

3.1. High-Level Formation Controller Design

To ensure that the formation controller of each UAV is offered with a sufficient number of state references, each high-level virtual agent is defined to have the homogeneous second-order dynamics as follows:
x ¯ ˙ i = v ¯ i , v ¯ ˙ i = S ( u ¯ i , U ¯ M i )
where x ¯ i R n and v ¯ i R n are the position and velocity information of the virtual agent, respectively; u ¯ i R n is the control input of the virtual agent; and S ( u ¯ i , U ¯ M i ) R n is the actuator saturation phenomenon. Define S ( u ¯ i ( j ) , U ¯ M i ) to be the jth element of S ( u ¯ i , U ¯ M i ) . Then we have
S ( u ¯ i ( j ) , U ¯ M i ) = u ¯ i ( j ) | u i ( j ) | U ¯ M i sign ( u ¯ i ( j ) ) U ¯ M i | u ¯ i ( j ) | > U ¯ M i
where U ¯ M i is a positive constant that represents the saturation limitation.
Accordingly, we have the following cluster expression:
x ¯ ˙ = v ¯ , v ¯ ˙ = S ( u ¯ )
where
S ( u ¯ ) = [ S T ( u ¯ 1 , U ¯ M 1 ) , S T ( u ¯ 2 , U ¯ M 2 ) , , S T ( u ¯ N , U ¯ M N ) ] T x ¯ = [ x ¯ 1 T , x ¯ 2 T , , x ¯ N T ] T , v ¯ = [ v ¯ 1 T , v ¯ 2 T , , v ¯ N T ] T
Regarding the virtual system Equation (10), we define the high-level tracking errors δ ¯ x i and δ ¯ v i as
δ ¯ x i = x ¯ i x i , p d δ ¯ v i = v ¯ i x ˙ i , p d
The tracking error dynamics for the ith virtual agent is given as:
δ ¯ ˙ x i = δ ¯ v i δ ¯ ˙ v i = S ( u ¯ i , U ¯ M i ) x ¨ i , p d
Then we have the virtual local formation tracking errors e ¯ x i and e ¯ v i as follows (respectively):
e ¯ x i = j = 1 N l i j δ ¯ x j + b i δ ¯ x i e ¯ v i = j = 1 N l i j δ ¯ v j + b i δ ¯ v i
where b i is the ith diagonal element of B. Define λ ¯ i to be a positive constant. Then the virtual sliding surface is designed as
s ¯ i = e ¯ v i + λ ¯ i S ¯ ( e ¯ x i , τ ¯ e , ψ ¯ e )
where τ ¯ e is a positive constant, ψ ¯ e is a very small positive constant and S ¯ ( e ¯ x i , τ ¯ e , ψ ¯ e ) R n is a bounded smooth projection function whose jth element is expressed as:
S ¯ ( e ¯ x i ( j ) , τ ¯ e , ψ ¯ e ) = τ ¯ e + ψ ¯ e 1 exp τ ¯ e e ¯ x i ( j ) ψ ¯ e , if e ¯ x i ( j ) > τ ¯ e e ¯ x i ( j ) , if | e ¯ x i ( j ) | τ ¯ e ψ ¯ e exp τ ¯ e + e ¯ x i ( j ) ψ ¯ e 1 τ ¯ e , if e ¯ x i ( j ) < τ ¯ e
Then we have the time derivative of the virtual sliding surface as:
s ¯ ˙ i = e ¯ ˙ v i + λ ¯ i diag { S ¯ d ( e ¯ x i , τ ¯ e , ψ ¯ e ) } e ¯ v i
where the jth element in S ¯ d ( e ¯ x i , τ ¯ e , ψ ¯ e ) has the following expression:
S ¯ d ( e ¯ x i ( j ) , τ ¯ e , ψ ¯ e ) = exp τ ¯ e e ¯ x i ( j ) ψ ¯ e , if e ¯ x i ( j ) > τ ¯ e 1 , if | e ¯ x i ( j ) | τ ¯ e exp τ ¯ e + e ¯ x i ( j ) ψ ¯ e , if e ¯ x i ( j ) < τ ¯ e
Define S ¯ = [ s ¯ 1 T , s ¯ 2 T , , s ¯ N T ] T , e ¯ x = [ e ¯ x 1 T , e ¯ x 2 T , , e ¯ x N T ] T , e ¯ v = [ e ¯ v 1 T , e ¯ v 2 T , , e ¯ v N T ] T and Λ ¯ = diag { λ ¯ 1 , , λ ¯ N } ; then the cluster expression is
S ¯ = e ¯ v + ( Λ ¯ I 3 ) S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e )
Based on the discussions about the tracking error (Equation (13)) and the sliding surface design (Equation (15)) of the virtual system (Equation (10)), we have the nominal high-level controller design as follows:
u ¯ i nom = x ¨ i , p d c ¯ i s ¯ i λ ¯ i diag { S ¯ d ( e ¯ x i , τ ¯ e , ψ ¯ e ) } δ ¯ v i k ¯ i δ ¯ x i
where c ¯ i and k ¯ i are both positive constants.
To ensure that the amplitudes of the control input stay within the saturation limitation, we have the following saturated high-level formation controller:
u ¯ i = S ¯ ( u ¯ i nom , τ ¯ u , ψ ¯ u )
where τ ¯ u and ψ ¯ u are both positive constants.
Now we are ready to present our result within high-level controller design:
Theorem 1.
Consider the virtual cluster equation—Equation (10)—where Assumption A1 holds due to the sliding surface design (Equation (15)) and the sliding mode controller (Equation (18)); the variables S ¯ , e ¯ x and δ ¯ x are all uniformly ultimately bounded (UUB).
Proof. 
Consider a Lyapunov candidate as follows:
V 1 = 1 2 S ¯ T P I 3 S ¯ + 1 2 e ¯ x T ( P K ¯ ) I 3 e ¯ x
where K ¯ = diag { k ¯ 1 , k ¯ 2 , , k ¯ N } .
The time derivative of V 1 is given as:
V ˙ = S ¯ T P I 3 S ¯ ˙ + e ¯ x T ( P K ¯ ) I 3 e ¯ ˙ x = S ¯ T P I 3 ( e ¯ ˙ v + Λ ¯ I 3 diag { S ¯ d ( e ¯ x , τ ¯ e , ψ ¯ e ) } e ¯ v ) + e ¯ x T ( P K ¯ ) I 3 ( S ¯ ( Λ ¯ I 3 ) S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e ) ) = S ¯ T ( P ( L + B ) ) I 3 ( δ ¯ ˙ v + Λ ¯ I 3 diag { S ¯ d ( e ¯ x , τ ¯ e , ψ ¯ e ) } δ ¯ v ) + e ¯ x T ( P K ¯ ) I 3 S ¯ e ¯ x T ( P K ¯ Λ ¯ ) I 3 S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e )
First, we rule out the saturation phenomenon (Equation (11)) and have u ¯ i = u ¯ i nom instead to test if the nominal controller is able to ensure the uniform ultimate boundedness of both s ¯ i and e ¯ x i . Then we have the modified version of V ˙ 1 as:
V ˙ 1 = S ¯ T ( P ( L + B ) C ¯ ) I 3 S ¯ S ¯ T ( P K ¯ ) I 3 e ¯ x + e ¯ x T ( P K ¯ ) I 3 S ¯ e ¯ x T ( P K ¯ Λ ¯ ) I 3 S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e ) = S ¯ T ( P ( L + B ) C ¯ ) I 3 S ¯ e ¯ x T ( P K ¯ Λ ¯ ) I 3 S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e )
By Lemma 1 and the inequality that S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e ) e ¯ x , we have the following norm form:
V ˙ 1 1 2 σ ̲ ( Q C ¯ ) S ¯ 2 σ ̲ ( P K ¯ Λ ¯ ) S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e ) 2
Hence, we get that V ˙ 1 will remain negative until S ¯ = S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e ) = 0 is achieved. By the characteristics of the smooth projection function S ¯ ( e ¯ x , τ ¯ e , ψ ¯ e ) , e ¯ x will also converge to the value of 0. According to Equation (14), we have that δ ¯ x = 0 is ultimately achieved as well. By the definition of uniformly ultimately bounded (UUB) in [38], we have that S ¯ , e ¯ x and δ ¯ x are all UUB, which indicates that the design of u ¯ i nom is able to achieve convergence of the virtual tracking error.
If we recall the saturation phenomenon (Equation (11)) and the saturated controller design (Equation (18)), similar results are also expected and the states S ¯ , e ¯ x and δ ¯ x are all UUB, which completes the proof.    □
Remark 2.
The virtual high-level agent Equation (10) is constructed with a saturation phenomenon Equation (11) to ensure that the states x ¯ i , v ¯ i and u ¯ i are a set of suitable and feasible reference vectors to prevent the low-level UAVs from causing aggressive motion (creating large pitch angles or rotational angles [25]).

3.2. Neural-Based Observer Design

Differently from the high-level design, it is vital to consider the system uncertainties w i for the low-level design. To maintain the robustness of the formation tracking process, one popular way is to employ the neural-based observer designs [34,35] to estimate the unknown terms and then perform compensation in the controller design. On the basis of the work in [35], the sliding mode technique is integrated with an artificial NN to approximate the unknown factor w i in system Equation (6).
Although the structures in [34,35] are effective for an arbitrary kind of uncertainty, the design of only using the NN output as the estimation value relies too much on the accuracy of the NN. In other words, if we were to use the designs in [34,35], then the difference between w ^ i and w i would be no less than ϵ i , which illustrates their limitation. To overcome this weakness, we propose to have an alternative way of analysing the problem. First, we build up an imaginary second-order observation system according to the actual system (Equation (6)):
x ^ ˙ i = v ^ i v ^ ˙ i = g i u i + u ^ i
where u ^ i is the imaginary control input, and vectors x ^ i and v ^ i represent our estimations of states x i and v i , respectively. As u i is the to be designed controller and g i is known in advance, the term g i u i is treated as the known dynamics for the imaginary system. By comparing the difference between the imaginary system Equation (19) and the actual UAV dynamics Equation (6), we have the following tracking error dynamics for the imaginary system:
x ˜ ˙ i = v ˜ i v ˜ ˙ i = w i u ^ i
where x ˜ i = x i x ^ i and v ˜ i = v i v ^ i are applied.
In theory, we have w i = u ^ i when both x ˜ i = 0 and v ˜ i = 0 are satisfied. Hence, our goal of building up an adaptive observer to estimate w i is also equivalent to designing a tracking controller u ^ i that reduces the value of x ˜ i and v ˜ i as much as possible. To achieve the uniformly ultimate boundedness of x ˜ i and v ˜ i , we define the observation sliding surface as
s ˜ i = v ˜ i + λ ˜ i x ˜ i
where λ ˜ i is a positive constant.
We have the derivative of the observation sliding surface as
s ˜ ˙ i = v ˜ ˙ i + λ ˜ i x ˜ ˙ i = w i u ^ i + λ ˜ i v ˜ i
Based on our previous discussion about the artificial NN estimation of w i Equation (9), we have the following neural adaptive sliding mode controller design for the imaginary system:
u ^ i = W ^ i T φ ( x i , v i ) + λ ˜ i v ˜ i + c ˜ i s ˜ i + k ˜ i x ˜ i
where c ˜ i and k ˜ i are both positive constants, and the update law of the NN is
W ^ ˙ i = η 1 φ ( x i , v i ) s ˜ i T η 2 s ˜ i W ^ i
where η 1 and η 2 are both positive constants.
Now we are ready to present our result of the neural-based sliding mode observer design.
Theorem 2.
Consider the system of Equation (19), where Assumption 2 is satisfied by the observation sliding variable (Equation (21)), the NN estimation (Equation (21)), the adaptive neural weight tuning law (Equation (23)) and the imaginary control input (Equation (22)). We have that the error states s ˜ i , x ˜ i and W ˜ i are all SGUUB if the compact set conditions of the NN hold such that we have x i ( t ) Ω x and u i ( t ) Ω u when t t 0 for the ith UAV.
Proof. 
Consider the following Lyapunov candidate:
V 2 = 1 2 s ˜ i T s ˜ i + 1 2 η 1 tr { W ˜ i T W ˜ i } + k ˜ i 2 x ˜ i T x ˜ i
Then we have the derivative of V 2 as follows:
V ˙ 2 = s ˜ i T s ˜ ˙ i 1 η 1 tr { W ˜ i T W ^ ˙ i } + k ˜ i x ˜ i T x ˜ ˙ i = s ˜ i T ( w i u ^ i + λ ˜ i v ˜ i ) 1 η 1 tr { W ˜ i T W ^ ˙ i } + k ˜ i x ˜ i T ( s ˜ i λ ˜ i x ˜ i ) = s ˜ i T ( W ˜ i T φ ( x i , v i ) + ϵ i c ˜ i s ˜ i ) 1 η 1 tr { W ˜ i T ( η 1 φ ( x i , v i ) s ˜ i T η 2 s ˜ i W ^ i ) } k ˜ i λ ˜ i x ˜ i T x ˜ i = c ˜ i s ˜ i T s ˜ i k ˜ i λ ˜ i x ˜ i T x ˜ i + s ˜ i T ϵ i + η 2 η 1 s ˜ i tr { W ˜ i T ( W i W ˜ i ) }
We can further modify Equation (24) into the following norm form:
V ˙ 2 c ˜ i s ˜ i 2 k ˜ i λ ˜ i x ˜ i 2 + s ˜ i ϵ M + η 2 η 1 s ˜ i W ˜ i F ( W M W ˜ i F ) c ˜ i s ˜ i 2 k ˜ i λ ˜ i x ˜ i 2 + s ˜ i ϵ M η 2 η 1 s ˜ i ( W ˜ i F 2 W M W ˜ i F + W M 2 4 W M 2 4 ) c ˜ i s ˜ i 2 k ˜ i λ ˜ i x ˜ i 2 + s ˜ i ϵ M η 2 η 1 s ˜ i ( W ˜ i F 2 W M 2 ) 2 + η 2 W M 2 4 η 1 s ˜ i c ˜ i s ˜ i 2 k ˜ i λ ˜ i x ˜ i 2 + s ˜ i ϵ M + η 2 W M 2 4 η 1 s ˜ i χ 1 T H 1 χ 1 + H 1 χ 1
where
χ 1 = s ˜ i x ˜ i , H 1 = ϵ M + η 2 W M 2 / 4 η 1 0
H 1 = c ˜ i 0 0 k ˜ i λ ˜ i
Hence, V ˙ 2 is said to be negative when the following condition is met:
χ 1 > 4 η 1 ϵ M + η 2 W M 2 4 η 1 σ ̲ ( H 1 )
By Definition 1, we have that the vector χ 1 is SGUUB within the following neighbourhood:
Ω χ 1 = χ 1 | χ 1 4 η 1 ϵ M + η 2 W M 2 4 η 1 σ ̲ ( H 1 )
Hence, the error states s ˜ i and x ˜ i are both SGUUB. According to the Lyapunov stability theory extension presented in [40], the correlated state W ˜ i is also SGUUB, which completes the proof.    □
As a result, we are confident to have w ˜ i w ˜ M , where w ˜ M is a positive constant, to support our result in the low-level formation controller design.

3.3. Low-Level Formation Controller Design

Regarding the low-level design, we need to first focus on the position loop to provide an essential reference for the attitude control loop [23]. Accordingly, the position loop dynamics (Equation (4)) and the attitude loop dynamics (Equation (5)) of the ith UAV are investigated for the low-level designs.
By Theorem 1, we have that the states x ¯ i , v ¯ i and u ¯ i will converge to x i , p d , x ˙ i , p d and x ¨ i , p d , respectively. Hence, it is reasonable to use states x ¯ i , v ¯ i and u ¯ i to act as the references for the ith low-level system. Define δ x i , p and δ v i , p to be the low-level reference tracking errors as follows:
δ x i , p = x i , p x ¯ i δ v i , p = v i , p v ¯ i , i [ 1 , N ] .
Then we have the tracking error dynamics as:
δ ˙ x i , p = δ v i , p δ ˙ v i , p = g i , p u i + w i , p u ¯ i g ¯ p , i [ 1 , N ]
Differently from the nominal system designs [35,41], we did not design u i directly from the perspective of Equation (26). Instead, we first defined u i , p = g i , p u i to denote the nominal control input of the position loop. Then we could rewrite Equation (26) as:
δ ˙ x i , p = δ v i , p δ ˙ v i , p = u i , p + w i , p u ¯ i g ¯ p , i [ 1 , N ]
The position loop sliding surface is constructed as follows:
s i , p = δ v i , p + λ i p δ x i , p
where λ i p is a positive constant.
The time derivative of the sliding surface is given as:
s ˙ i , p = δ ˙ v i , p + λ i p δ v i , p = u i , p + w i , p u ¯ i + λ i p δ v i , p g ¯ p
By the neural-based observer design, we have u ^ i = w ^ i , where w ^ i = [ w ^ i , p T , w ^ i , a T ] T represents our estimation of the system uncertainty w i .
Based on the discussion about the neural-based observer Equation (22) and the potential-based position loop sliding variable (Equation (28)), we have the following nominal controller design:
u i , p = u ¯ i w ^ i , p λ i p δ v i , p k i p δ x i , p c i p s i , p + g ¯ p
where k i p R + and c i p R + .
Now we are ready to present our results in the low-level nominal controller design for the position loop Equation (4) of the ith UAV.
Theorem 3.
Consider the nominal position loop dynamics of the ith UAV (Equation (4)), where Assumptions 1-2 are satisfied by the neural-based observer (Equation (22)) and the nominal control law (Equation (29)). The states δ x i , p and s i , p are both SGUUB if the compact set conditions of the NN hold such that we have x i ( t ) Ω x and u i ( t ) Ω u when t t 0 for the ith UAV.
Proof. 
Consider the following Lyapunov candidate for the ith UAV:
V i , p = 1 2 s i , p T s i , p + k i p 2 δ x i , p T δ x i , p
The time derivative of the Lyapunov candidate (Equation (30)) is:
V ˙ i , p = s i , p T s ˙ i , p + k i p δ x i , p T δ ˙ x i , p = s i , p T ( δ ˙ v i , p + λ i p δ v i , p ) + k i p δ x i , p T ( s i , p λ i p δ x i , p ) = s i , p T ( u i , p + w i , p u ¯ i g ¯ p + λ i p δ v i , p ) + k i p δ x i , p T ( s i , p λ i p δ x i , p ) = s i , p T ( w ˜ i , p k i p δ x i , p c i p s i , p ) k i p λ i p δ x i , p T δ x i , p + k i p δ x i , p T s i , p c i p s i , p 2 + s i , p w ˜ M k i p λ i p δ x i , p 2
where w ˜ i , p = w i , p w ^ i , p .
Alternatively, we have the following matrix form:
V ˙ i , p χ 2 T H 2 χ 2 + H 2 χ 2
where
χ 2 = s i , p δ x i , p , H 2 = w ˜ M 0 , H 2 = c i p 0 0 k i p λ i p
Hence, V ˙ i , p is guaranteed to be negative within the following region:
χ 2 > w ˜ M σ ̲ ( H 2 )
By Definition 1, we have that the vector χ 2 is SGUUB within the following region:
Ω χ 2 = χ 2 | χ 2 w ˜ M σ ̲ ( H 2 )
As in the case of χ 2 , the values of s i , p and δ x i , p are both SGUUB, which completes the proof.    □
After obtaining the nominal control u i , p , the next step is to use the flight control techniques to calculate the reference for the row angle and the yaw angle. Inspired by [24], with u i , p = [ u i , x , u i , y , u i , z ] T , we have a new guidance law for T i d :
T i d = m i u i , z cos ( ϕ i ) cos ( θ i ) ϕ i d = arcsin ( u i , x sin ( ψ i d ) u i , y cos ( ψ i d ) ) ( u i , x 2 + u i , y 2 + u i , z 2 ) 1 / 2 θ i d = arctan u i , x cos ( ψ i d ) + u i , y sin ( ψ i d ) u i , z
After both ϕ i d and θ i d are calculated, we can use the conventional approach of calculating the slope between the current value and the previous value to get the value of ϕ ˙ i d , ϕ ¨ i d , θ ˙ i d , θ ¨ i d , ψ ˙ i d and ψ ¨ i d as follows:
ξ i , 1 = [ 0 , 0 , 0 ] T t t step x i , a d ( t ) x i , a d ( t t step ) t step t > t step
where ξ i , 1 is the estimation of x ˙ i , a d , t represents the current time and t step is the control step size. Similarly, we have the following structure to get the second-order derivative as:
ξ i , 2 = [ 0 , 0 , 0 ] T t 2 t step ξ i , 1 ( t ) ξ i , 1 ( t t step ) t step t > 2 t step
Accordingly, we have ξ i , 1 = x ˙ i , a d and ξ i , 2 = x ¨ i , a d when t > 2 t step . Similarly to the position loop, define δ x i , a and δ v i , a to be the reference tracking errors in the attitude loop, which further leads to
δ x i , a = x i , a x i , a d δ v i , a = v i , a x ˙ i , a d , i [ 1 , N ]
If we define u i , a = g i , a u i to be the nominal control input for the attitude loop, we have the error dynamics as follows:
δ ˙ x i , a = δ v i , a δ ˙ v i , a = u i , a + w i , a x ¨ i , a d , i [ 1 , N ]
Differently from the position loop, the vector δ v i , a cannot be directly obtained because x ˙ i , a d is unknown to the ith UAV. Instead, the UAV can only gain access to the estimated error vector δ ^ v i , a as
δ ^ v i , a = v i , a ξ i , 1
Accordingly, we have the actual sliding surface for the attitude loop as s i , a = δ v i , a + λ i a δ x i , a , and the estimated sliding variable is given as
s ^ i , a = δ ^ v i , a + λ i a δ x i , a
where λ i a is a positive constant. The time derivative of the actual sliding surface s i , a is
s ˙ i , a = δ ˙ v i , a + λ i a δ v i , a = u i , a + w i , a x ¨ i , a d + λ i a δ v i , a
Based on our discussion about the neural-based observer Equation (22) and the estimated attitude loop sliding variable Equation (36), we have the following nominal controller design:
u i , a = ξ i , 2 w ^ i , a λ i a δ ^ v i , a k i a δ x i , a c i a s ^ i , a
where k i a and c i a are both positive constants.
Now we are ready to present our result in the low-level nominal controller design for the attitude loop of the ith UAV:
Theorem 4.
Consider the nominal attitude loop dynamics of the ith UAV (Equation (5)), where Assumptions 1 and 2 are satisfied by the neural-based observer (Equation (22)), the first-order differentiator (Equation (32)), the second-order differentiator (Equation (33) ) and the nominal control law (Equation (37)). The states δ x i , a and s i , a are both SGUUB if the compact set conditions of the NN hold such that we have x i ( t ) Ω x and u i ( t ) Ω u when t t 0 for the ith UAV.
Proof. 
Consider the following Lyapunov candidate.
V i , a = 1 2 s i , a T s i , a + k i a 2 δ x i , a T δ x i , a
Then we have the time derivative of V i , a as
V ˙ i , a = s i , a T s ˙ i , a + k i a δ x i , a T δ ˙ x i , a = s i , a T ( δ ˙ v i , a + λ i a δ v i , a ) + k i a δ x i , a T ( s i , a λ i a δ x i , a ) = s i , a T ( u i , a + w i , a x ¨ i , a d + λ i a δ v i , a ) + k i a δ x i , a T ( s i , a λ i a δ x i , a ) = s i , a T ( w ˜ i , a k i a δ x i , a c i a s ^ i , a + ξ i , 2 x ¨ i , a d + λ i a ( δ v i , a δ ^ v i , a ) ) k i a λ i a δ x i , a T δ x i , a + k i a δ x i , a T s i , a
where w ˜ i , p = w i , p w ^ i , p . We have ξ i , 1 = x ˙ i , a d , ξ i , 2 = x ¨ i , a d , δ v i , a = δ ^ v i , a and s i , a = s ^ i , a when t > 2 t step . Therefore, Equation (38) should be rewritten as:
V ˙ i , a = s i , a T ( w ˜ i , a c i a s i , a ) k i a λ i a δ x i , a T δ x i , a c i a s i , a 2 + w ˜ M s i , a k i a λ i a δ x i , a 2
Similarly, we also have the following matrix form:
V ˙ i , a χ 3 T H 3 χ 3 + H 3 χ 3
where
χ 3 = s i , a δ x i , a , H 3 = w ˜ M 0 , H 3 = c i a 0 0 k i a λ i a
Hence, V ˙ i , a is negative within the following region:
χ 3 > w ˜ M σ ̲ ( H 3 )
By Definition 1, we have that the vector χ 3 is SGUUB within the following region:
Ω χ 3 = χ 3 | χ 3 w ˜ M σ ̲ ( H 3 )
As in the case of χ 3 , the values of s i , a and δ x i , a are both SGUUB, which completes the proof.    □
As the position loop and the attitude loop are strongly coupled, a subtle fluctuation in the output of any part of the controller design can lead to oscillation in the system states. Regarding the designs covered by Theorems 1–4, there are two factors that can lead to potential oscillations in the system’s control input:
1.
The values of θ i d and ψ i d are not guaranteed to be smooth because they are generated by the reverse calculation (Equation (31)). Hence, the output values of the direct derivative structures (Equations (32) and (33)) can be filled with chattering because of the discontinuity of their input.
2.
Before W ^ i W i F is settled within a neighbourhood around 0, the output of the NN is usually filled with oscillations [35].
Before we introduce the saturated and smoothed differentiator, we need to first make the following assumption:
Assumption 3.
The vectors x ˙ i , a d and x ¨ i , a d are both bounded such that lim t + | x ˙ i , a d | ξ M 1 1 3 and lim t + | x ¨ i , a d | ξ M 2 1 3 are met simultaneously.
Consequently, we have the saturated and smoothed differentiator designs, as shown in Algorithm 1, where l ξ is initially set as 0. Accordingly, we have
ξ i , 1 = D ( t step , t diff , x i , a d , t , ξ M 1 ) ξ i , 2 = D ( 2 t step , t diff , ξ i , 1 , t , ξ M 2 )
where t diff is the differentiate step size.
Algorithm 1: Saturated and smoothed differentiator D ( t delay , t diff , ξ in + , t , ξ M ) .
Drones 06 00040 i001
To reduce the negative effect brought about by the fluctuations in the NN’s output, the following observation introduction function is proposed to smoothly introduce the uncertainty estimations w ^ i , p and w ^ i , a into the low-level controller designs.
f ¯ ( t ) = 1 exp ( γ 1 ( t γ 2 ) ) 1 + exp ( γ 1 ( t γ 2 ) )
where γ 1 and γ 2 are both positive constants.
Hence, instead of using w ^ i , p and w ^ i , a directly, we have the following smoothed position controller and attitude controller:
u i , p s = u ¯ i f ¯ ( t ) w ^ i , p λ i p δ v i , p k i p δ x i , p c i p s i , p + g ¯ p
u i , a s = ξ i , 2 f ¯ ( t ) w ^ i , a λ i a δ ^ v i , a k i a δ x i , a c i a s ^ i , a
Ultimately, we have the following motion controller design:
T i = g ¯ p T u i , p s g cos ( ϕ i ) cos ( θ i ) τ i = g i , a 1 u i , a
In all, the hierarchical formation controller is illustrated as Figure 1. Now, we are ready to present our final result in the overall system design.
Theorem 5.
Consider a group of UAVs (Equation (7)) with a strongly connected communication topology, where Assumptions 1–3 are satisfied, by the high-level formation controller in Equation (18), the smoothed low-level position loop controller in Equation (41), the smoothed low-level attitude formation controller in Equation (42) and the actual motion controller in Equation (43). The values of x i , p x i , p d and ψ i ψ i d are both SGUUB if the compact set conditions of the NN hold such that we have x i ( t ) Ω x and u i ( t ) Ω u when t t 0 for the ith UAV.
Proof. 
By Theorem 1, we have
lim t + x ¯ i x i , p d = 0 , lim t + v ¯ i x ˙ i , p d = 0 , lim t + v ¯ i x ¨ i , p d = 0
Since the value of the introduction function Equation (40) will converge to 1 ultimately, the result and analysis related to Theorem 3 remain the same.
Although the smoothed design in Algorithm 1 will lead to differences between the set { ξ i , 1 , ξ i , 2 } and { x ˙ i , a d , x ¨ i , a d } , the difference should be small and bounded if the value of t diff is chosen properly. Suppose we have ξ i , 1 x ˙ i , a d ξ ˜ M 1 and ξ i , 2 x ¨ i , a d ξ ˜ M 2 , similar to the proof of Theorem 4. We have that
lim t + x i , a x i , a d w ˜ M + ( λ i a + c i a ) ξ ˜ M 1 + ξ ˜ M 2 σ ̲ ( H 4 )
where ξ ˜ M 1 and ξ ˜ M 2 are both small positive constants.
With the actual motion controller chosen as Equation (43), we have that:
lim t + x i , p x ¯ i w ˜ M + ( λ i a + c i a ) ξ ˜ M 1 + ξ ˜ M 2 σ ̲ ( H 3 ) lim t + x i , a x i , a d w ˜ M + ( λ i a + c i a ) ξ ˜ M 1 + ξ ˜ M 2 σ ̲ ( H 4 )
which matches the goal of this paper (Equation (8)) and concludes the proof. □

4. Simulation Results and Discussion

To justify the performance of the proposed hierarchical formation controller design, comparative simulations based on a multi-UAV system were conducted.
Consider a multi-UAV system that contains six heterogeneous UAVs whose dynamics are expressed as Equation (1). The system’s parameter values are given in Table 2, where we have K i = K i , x = K i , y = K i , z = K i , ϕ = K i , θ = K i , ψ .
The gravity constant g was set to g = 9.81 . The communication topology of the system was chosen as shown in Figure 2, and we used b i = 1 for i [ 1 , 6 ] .
The initial states are chosen as x 1 , p = x ^ 1 , p = x ¯ 1 = [ 4 , 1 , 0 ] T , x 2 , p = x ^ 2 , p = x ¯ 2 = [ 1 , 2 , 0 ] T , x 3 , p = x ^ 3 , p = x ¯ 3 = [ 2 , 4 , 0 ] T , x 4 , p = x ^ 4 , p = x ¯ 4 = [ 4 , 1 , 0 ] T , x 5 , p = x ^ 5 , p = x ¯ 5 = [ 1.5 , 1 , 0 ] T and x 6 , p = x ^ 6 , p = x ¯ 6 = [ 0 , 1 , 0 ] T . All the other states were set as zero vectors or zero matrices when t = 0 .
The position reference for the ith UAV was chosen as
x i , p d = [ 3 cos ( 0.08 t + ( i 1 ) π / 3 ) , 3 sin ( 0.08 t + ( i 1 ) π / 3 ) , 0.5 + 0.15 t ] T
The reference of the yaw angle was chosen as ψ i d = 0 . The system uncertainties were chosen as follows:
w ¯ i , p = [ 0.6 sin ( 0.3 t + i π / 6 ) , 0.8 sin ( 0.2 t + i π / 5 ) , 0.9 sin ( 0.2 t + i π / 4 ) ] T w ¯ i , a = [ 0.1 sin ( 0.5 t i π / 6 ) , 0.08 sin ( 0.6 t i π / 5 ) , 0.06 sin ( 0.4 t i π / 4 ) ] T
The parameters of the high level controller were chosen as U ¯ M i = 0.2 , τ ¯ e = 0.5 , ψ ¯ e = 0.05 , c ¯ i = 1 , λ ¯ i = 2 , k ¯ i = 1.5 , τ ¯ u = 0.19 and ψ ¯ u = 0.01 . To illustrate the effectiveness of the high-level formation controller (Equation (18)), the norms of the high-level error-related vectors δ ¯ x i and s ¯ i are given in Figure 3 and Figure 4, respectively.
Although the performance of the sliding mode controller (Equation (18)) was affected by the saturation phenomenon (Equation (11)) and obvious state overshoots can be noted, the uniform ultimate boundedness of both δ ¯ x i and s ¯ i was still achieved simultaneously, which validates the results presented in Theorem 1.
The parameters of the neural-based observer were selected as λ ˜ i = 2 , c ˜ i = 4 , k ˜ i = 4 , η 1 = 20 and η 2 = 0.5 . Define x ˜ , s ˜ and d ˜ as follows to represent the overall state observation error norm, overall observation sliding variable norm and uncertainty estimation error norm, respectively.
x ˜ = i = i N x ˜ i 2 , s ˜ = i = i N s ˜ i 2 , w ˜ = i = i N w ˜ i 2
Then we have the values of x ˜ , s ˜ and d ˜ as shown in Figure 5, where we found that all three norms are SGUUB for 2 × 10 3 . Hence, Theorem 2 was verified. However, both overshooting and chattering were observed in the output of the neural-based observer within the first 2 s, which validates our motivation of employing the observation introduction function Equation (40).
The parameters of the low-level position controller were chosen as λ i p = 2 , c i p = 2 and k i p = 2 ; and the parameters of the low-level attitude controller were selected as λ i a = 2 , c i a = 4 and k i a = 4 . To illustrate the stability of our low-level controller design, we define error norm vectors δ x , a , δ x , p , s a and s p as follows:
δ x , a = i = i N δ x i , a 2 , δ x , p = i = i N δ x i , p 2 , s a = i = i N s i , a 2 , s p = i = i N s i , p 2
The trends of δ x , a , δ x , p , s a and s p are recorded in Figure 6, where they are SGUUB for 4 × 10 4 , 7 × 10 4 , 3 × 10 4 and 1.5 × 10 3 . Hence, the both Theorem 3 and 4 are valid.
To prove that the observation introduction function (Equation (40)) and the saturated differentiator (Algorithm 1) help attenuate the chattering in the control input, the following two comparative simulations were conducted:
1.
The original controller (TOC) where both Equation (32) and Equation (33) are employed to provide the derivatives of the attitude reference x i , a d . The derivatives are saturated with ξ i , 1 = S ( ξ i , 1 , 0.2 ) and ξ i , 2 = S ( ξ i , 2 , 0.1 ) .
2.
The smoothed controller (TSC) where the observation introduction function Equation (40) is employed with γ 1 = 4 and γ 2 = 2 , and the attitude reference derivatives are obtained as
ξ i , 1 = D ( t step , 10 t step , x i , a d , t , 0.2 ) , ξ i , 2 = D ( 2 t step , 10 t step , ξ i , 1 , t , 0.1 )
where the overall controller is chosen simultaneously with Equation (43). Furthermore, we have the results shown in Figure 7 and Figure 8.
As the introduction function (Equation (40)) is not used in the TOC design, more chattering was observed in the control input for the first 4 s. Besides, the TSC design was found to have smoother control input ultimately (see UAV 2 and 6) due to the implementation of the smoothed differentiator (Algorithm 1). Therefore, the effectiveness of the TSC design and its superiority over the TOC design are both illustrated.
Finally, define x p d = [ x 1 , p d , x 2 , p d , , x N , p d ] T and x p = [ x 1 , p , x 2 , p , , x N , p ] T to represent the overall formation reference and the actual position of the multi-UAV system, respectively. Then we have the norm of the overall reference tracking error of the system with TSC design, as shown in Figure 9, where the semi-global uniform ultimate boundedness of x p x p d proves the validity of Theorem 5.
The trajectories of all UAVs are given in Figure 10 to illustrate the movement and formation status of the entire system. According to Equation (46), the desired formation is a rotating circle that keeps on elevating (see the dotted grey circle). In Figure 10, each UAV successfully reached its position reference within bounded error to form the desired formation, which illustrates the effectiveness of the proposed design structure in Figure 1. The angular status of each UAV is also given in Figure 11 to indicate that the saturation phenomenon employed in the higher level helps restrict the pitch and roll angle within [ 30 , 30 ] to further reduce the aggressive motion of each UAV.

5. Conclusions

In this paper, the robust formation control problem for a group of UAVs with system uncertainties was investigated. A neural-based hierarchical formation controller was proposed to ensure the semi-global uniform ultimate boundedness of the system’s formation tracking error. A cluster of saturated high-level agents were defined to act as the smooth reference generator, and a saturated sliding mode controller was proposed to ensure the convergence of the high-level tracking errors. The sliding mode technique was further integrated with the neural-based observer structure to estimate system uncertainties in both the position loop and the angular loop. Adaptive sliding mode observers were then introduced for both position and angular loops to perform adaptive estimation of the system uncertainties. To reduce the chattering and oscillation in the control input, a combination of the smoothed differentiator and the observation introduction function is employed for each UAV. The effectiveness of the robust and adaptive hierarchical formation control scheme was validated by both theoretical analysis and comparative simulations.

Author Contributions

Conceptualization, Y.F.; methodology, Y.F. and Y.S.; software, Y.F.; validation, Y.F.; formal analysis, Y.F. and Y.S.; investigation, Y.F.; resources, Y.F.; data curation, Y.F.; writing—original draft preparation, Y.F. and Y.S.; writing—review and editing, P.S.; visualization, Y.F.; supervision, P.S.; project administration, P.S.; funding acquisition, P.S. All authors have read and agreed to the published version of the manuscript.

Funding

This work was funded by the Key-area Research and Development Program of Guangdong Province (2020B0909020001) and the Dongguan Innovative Research Team Program (2020607202006).

Informed Consent Statement

Not applicable.

Data Availability Statement

The data that support the findings of this study are available from the corresponding author upon reasonable request.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Olfati-Saber, R.; Murray, R.M. Consensus Problems in Networks of Agents with Switching Topology and Time-Delays. IEEE Trans. Autom. Control. 2004, 49, 1520–1533. [Google Scholar] [CrossRef] [Green Version]
  2. Sun, Y.; Shi, P.; Lim, C.C. Event-triggered sliding mode scaled consensus control for multi-agent systems. J. Frankl. Inst. 2022, 359, 981–998. [Google Scholar] [CrossRef]
  3. Fei, Y.; Shi, P.; Lim, C.C. Neural network adaptive dynamic sliding mode formation control of multi-agent systems. Int. J. Syst. Sci. 2020, 51, 2025–2040. [Google Scholar] [CrossRef]
  4. Shi, P.; Yan, B. A Survey on Intelligent Control for Multiagent Systems. IEEE Trans. Syst. Man, Cybern. Syst. 2020, 51, 161–175. [Google Scholar] [CrossRef]
  5. Xiong, S.; Hou, Z. Data-Driven Formation Control for Unknown MIMO Nonlinear Discrete-Time Multi-Agent Systems with Sensor Fault. IEEE Trans. Neural Netw. Learn. Syst. 2021. [Google Scholar] [CrossRef] [PubMed]
  6. Sun, Y.; Shi, P.; Lim, C.C. Event-triggered adaptive leaderless consensus control for nonlinear multi-agent systems with unknown backlash-like hysteresis. Int. J. Robust Nonlinear Control. 2021, 31, 7409–7424. [Google Scholar] [CrossRef]
  7. Liang, X.; Qu, X.; Wang, N.; Li, Y.; Zhang, R. Swarm control with collision avoidance for multiple underactuated surface vehicles. Ocean. Eng. 2019, 191, 106516. [Google Scholar] [CrossRef]
  8. Divband Soorati, M.; Clark, J.; Ghofrani, J.; Tarapore, D.; Ramchurn, S.D. Designing a User-Centered Interaction Interface for Human–Swarm Teaming. Drones 2021, 5, 131. [Google Scholar] [CrossRef]
  9. Loizou, S.; Lui, D.G.; Petrillo, A.; Santini, S. Connectivity Preserving Formation Stabilization in an obstacle-cluttered environment in the presence of time-varying communication delays. IEEE Trans. Autom. Control. 2021. [Google Scholar] [CrossRef]
  10. Fahham, H.; Zaraki, A.; Tucker, G.; Spong, M.W. Time-Optimal Velocity Tracking Control for Consensus Formation of Multiple Nonholonomic Mobile Robots. Sensors 2021, 21, 7997. [Google Scholar] [CrossRef]
  11. Martinez, J.B.; Becerra, H.M.; Gomez-Gutierrez, D. Formation Tracking Control and Obstacle Avoidance of Unicycle-Type Robots Guaranteeing Continuous Velocities. Sensors 2021, 21, 4374. [Google Scholar] [CrossRef]
  12. Samadi Gharajeh, M.; Jond, H.B. Speed Control for Leader-Follower Robot Formation Using Fuzzy System and Supervised Machine Learning. Sensors 2021, 21, 3433. [Google Scholar] [CrossRef] [PubMed]
  13. Chen, B.; Cheng, H.H. A Review of the Applications of Agent Technology in Traffic and Transportation Systems. IEEE Trans. Intell. Transp. Syst. 2010, 11, 485–497. [Google Scholar] [CrossRef]
  14. Wang, C.; Tnunay, H.; Zuo, Z.; Lennox, B.; Ding, Z. Fixed-Time Formation Control of Multirobot Systems: Design and Experiments. IEEE Trans. Ind. Electron. 2018, 66, 6292–6301. [Google Scholar] [CrossRef] [Green Version]
  15. Kendoul, F.; Yu, Z.; Nonami, K. Guidance and nonlinear control system for autonomous flight of minirotorcraft unmanned aerial vehicles. J. Field Robot. 2010, 27, 311–334. [Google Scholar] [CrossRef]
  16. Dong, X.; Zhou, Y.; Ren, Z.; Zhong, Y. Time-Varying Formation Tracking for Second-Order Multi-Agent Systems Subjected to Switching Topologies with Application to Quadrotor Formation Flying. IEEE Trans. Ind. Electron. 2016, 64, 5014–5024. [Google Scholar] [CrossRef]
  17. Ali, Z.A.; Han, Z.; Masood, R.J. Collective Motion and Self-Organization of a Swarm of UAVs: A Cluster-Based Architecture. Sensors 2021, 21, 3820. [Google Scholar] [CrossRef]
  18. Mehmood, Y.; Aslam, J.; Ullah, N.; Chowdhury, M.; Techato, K.; Alzaed, A.N. Adaptive Robust Trajectory Tracking Control of Multiple Quad-Rotor UAVs with Parametric Uncertainties and Disturbances. Sensors 2021, 21, 2401. [Google Scholar] [CrossRef]
  19. Mukhamediev, R.I.; Symagulov, A.; Kuchin, Y.; Zaitseva, E.; Bekbotayeva, A.; Yakunin, K.; Assanov, I.; Levashenko, V.; Popova, Y.; Akzhalova, A.; et al. Review of Some Applications of Unmanned Aerial Vehicles Technology in the Resource-Rich Country. Appl. Sci. 2021, 11, 10171. [Google Scholar] [CrossRef]
  20. Zhang, Z.; Yang, P.; Hu, X.; Wang, Z. Sliding Mode Prediction Fault-Tolerant Control of a Quad-Rotor System with Multi-Delays Based on ICOA. Int. J. Innov. Comput. Inf. Control. 2021, 17, 49–66. [Google Scholar]
  21. Dong, X.; Hua, Y.; Zhou, Y.; Ren, Z.; Zhong, Y. Theory and Experiment on Formation-Containment Control of Multiple Multirotor Unmanned Aerial Vehicle Systems. IEEE Trans. Autom. Sci. Eng. 2018, 16, 229–240. [Google Scholar] [CrossRef]
  22. Zhao, B.; Xian, B.; Zhang, Y.; Zhang, X. Nonlinear Robust Adaptive Tracking Control of A Quadrotor UAV via Immersion and Invariance Methodology. IEEE Trans. Ind. Electron. 2015, 62, 2891–2902. [Google Scholar] [CrossRef]
  23. Du, H.; Zhu, W.; Wen, G.; Wu, D. Finite-time formation control for a group of quadrotor aircraft. Aerosp. Sci. Technol. 2017, 69, 609–616. [Google Scholar] [CrossRef]
  24. Ren, Y.; Zhang, K.; Jiang, B.; Cheng, W.; Ding, Y. Distributed fault-tolerant time-varying formation control of heterogeneous multi-agent systems. Int. J. Robust Nonlinear Control. 2021. [Google Scholar] [CrossRef]
  25. Tang, S.; Wüest, V.; Kumar, V. Aggressive Flight with Suspended Payloads Using Vision-Based Control. IEEE Robot. Autom. Lett. 2018, 3, 1152–1159. [Google Scholar] [CrossRef]
  26. Lu, N.; Sun, X.; Zheng, X.; Shen, Q. Command Filtered Adaptive Fuzzy Backstepping Fault Tolerant Control Against Actuator Fault. Icic Express Lett. 2021, 15, 357–365. [Google Scholar]
  27. Yu, D.; Dong, L.; Yan, H. Adaptive sliding mode control of multi-agent relay tracking systems with disturbances. J. Control. Decis. 2021, 8, 165–174. [Google Scholar] [CrossRef]
  28. Yu, Z.; Zhang, Y.; Jiang, B.; Su, C.Y.; Fu, J.; Jin, Y.; Chai, T. Fractional order PID-based adaptive fault-tolerant cooperative control of networked unmanned aerial vehicles against actuator faults and wind effects with hardware-in-the-loop experimental validation. Control. Eng. Pract. 2021, 114, 104861. [Google Scholar] [CrossRef]
  29. Casavola, A.; Famularo, D.; Gagliardi, G. A linear parameter varying fault detection and isolation method for internal combustion spark ignition engines. Int. J. Robust Nonlinear Control. 2014, 24, 2018–2034. [Google Scholar] [CrossRef]
  30. Behzad, H.; Casavola, A.; Tedesco, F.; Sadrnia, M.A.; Gagliardi, G. A Fault-Tolerant Sensor Reconciliation Scheme based on Self-Tuning LPV Observers. ICINCO 2018, 1, 121–128. [Google Scholar]
  31. Gagliardi, G.; Tedesco, F.; Casavola, A. H calibratable LPV control strategies for torque control in automotive turbocharged engines. Int. J. Control. 2021. [Google Scholar] [CrossRef]
  32. Dou, L.; Su, X.; Zhao, X.; Zong, Q.; He, L. Robust tracking control of quadrotor via on-policy adaptive dynamic programming. Int. J. Robust Nonlinear Control. 2021, 31, 2509–2525. [Google Scholar] [CrossRef]
  33. Zhang, L.; Chen, M.; Wu, B. Observer-Based Controller Design for Networked Control Systems with Induced Delays and Data Packet Dropouts. ICIC Express Lett. Part Appl. 2021, 12, 243–254. [Google Scholar]
  34. Liu, D.; Huang, Y.; Wang, D.; Wei, Q. Neural-network-observer-based optimal control for unknown nonlinear systems using adaptive dynamic programming. Int. J. Control. 2013, 86, 1554–1566. [Google Scholar] [CrossRef]
  35. Fei, Y.; Shi, P.; Lim, C.C. Robust and Collision-Free Formation Control of Multiagent Systems with Limited Information. IEEE Trans. Neural Netw. Learn. Syst. 2021. [Google Scholar] [CrossRef]
  36. Sharma, R.S.; Mondal, A.; Behera, L. Tracking Control of Mobile Robots in Formation in the Presence of Disturbances. IEEE Trans. Ind. Inform. 2020, 17, 110–123. [Google Scholar] [CrossRef]
  37. Ge, S.S.; Hang, C.C.; Lee, T.H.; Zhang, T. Stable Adaptive Neural Network Control; Springer Science & Business Media: New York, NY, USA, 2013; Volume 13. [Google Scholar]
  38. Lewis, F.L.; Zhang, H.; Hengster-Movric, K.; Das, A. Cooperative Control of Multi-Agent Systems: Optimal and Adaptive Design Approaches; Springer Science & Business Media: London, UK, 2013. [Google Scholar]
  39. Li, X.; Shi, P.; Wang, Y.; Wang, S. Cooperative Tracking Control of Heterogeneous Mixed-Order Multiagent Systems With Higher-Order Nonlinear Dynamics. IEEE Trans. Cybern. 2020. [Google Scholar] [CrossRef]
  40. Kim, Y.H.; Lewis, F.L. Neural Network Output Feedback Control of Robot Manipulators. IEEE Trans. Robot. Autom. 1999, 15, 301–309. [Google Scholar] [CrossRef]
  41. Fei, Y.; Shi, P.; Lim, C.C. Robust Formation Control for Multi-Agent Systems: A Reference Correction Based Approach. IEEE Trans. Circuits Syst. Regul. Pap. 2021, 68, 2616–2625. [Google Scholar] [CrossRef]
Figure 1. Hierarchical control diagram.
Figure 1. Hierarchical control diagram.
Drones 06 00040 g001
Figure 2. Communication topology.
Figure 2. Communication topology.
Drones 06 00040 g002
Figure 3. Norms of high-level reference tracking errors.
Figure 3. Norms of high-level reference tracking errors.
Drones 06 00040 g003
Figure 4. Norms of high-level sliding variables.
Figure 4. Norms of high-level sliding variables.
Drones 06 00040 g004
Figure 5. Effectiveness of the neural-based observer.
Figure 5. Effectiveness of the neural-based observer.
Drones 06 00040 g005
Figure 6. Effectiveness of the low-level controller.
Figure 6. Effectiveness of the low-level controller.
Drones 06 00040 g006
Figure 7. Control inputs of TOC.
Figure 7. Control inputs of TOC.
Drones 06 00040 g007
Figure 8. Control inputs of TSC.
Figure 8. Control inputs of TSC.
Drones 06 00040 g008
Figure 9. Norm of the overall reference tracking error.
Figure 9. Norm of the overall reference tracking error.
Drones 06 00040 g009
Figure 10. Illustration of system formation and individual trajectories.
Figure 10. Illustration of system formation and individual trajectories.
Drones 06 00040 g010
Figure 11. Trends of angular states.
Figure 11. Trends of angular states.
Drones 06 00040 g011
Table 1. Parameter definitions.
Table 1. Parameter definitions.
Term(s)Definition
K i , x , K i , y , K i , z , K i , ϕ , K i , θ , K i , ψ Aerodynamic drag coefficients
w ¯ i , x , w ¯ i , y , w ¯ i , z , w ¯ i , ϕ , w ¯ i , θ , w ¯ i , ψ External disturbances
J i , x , J i , y , J i , z Moments of inertia around the axis
m i The mass of the UAV
gThe gravity constant
υ i The drag force coefficient
Table 2. UAV system parameters.
Table 2. UAV system parameters.
UAV Number m i  (kg) R i  (m) J i , x ( Ns 2 / rad ) J i , y ( Ns 2 / rad ) J i , z ( Ns 2 / rad ) K i ( Ns 2 / rad ) υ i
1 2.08 0.29 1.25 1.24 2.50 1.2 × 10 2 5.1 × 10 2
2 2.10 0.31 1.23 1.25 2.52 1.3 × 10 2 5.2 × 10 2
3 2.11 0.30 1.24 1.24 2.51 1.4 × 10 2 4.9 × 10 2
4 2.10 0.32 1.23 1.26 2.49 1.1 × 10 2 5.1 × 10 2
5 2.09 0.34 1.24 1.23 2.50 1.2 × 10 2 4.8 × 10 2
6 2.12 0.33 1.25 1.26 2.53 1.3 × 10 2 5.3 × 10 2
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Fei, Y.; Sun, Y.; Shi, P. Robust Hierarchical Formation Control of Unmanned Aerial Vehicles via Neural-Based Observers. Drones 2022, 6, 40. https://doi.org/10.3390/drones6020040

AMA Style

Fei Y, Sun Y, Shi P. Robust Hierarchical Formation Control of Unmanned Aerial Vehicles via Neural-Based Observers. Drones. 2022; 6(2):40. https://doi.org/10.3390/drones6020040

Chicago/Turabian Style

Fei, Yang, Yuan Sun, and Peng Shi. 2022. "Robust Hierarchical Formation Control of Unmanned Aerial Vehicles via Neural-Based Observers" Drones 6, no. 2: 40. https://doi.org/10.3390/drones6020040

APA Style

Fei, Y., Sun, Y., & Shi, P. (2022). Robust Hierarchical Formation Control of Unmanned Aerial Vehicles via Neural-Based Observers. Drones, 6(2), 40. https://doi.org/10.3390/drones6020040

Article Metrics

Back to TopTop