Next Article in Journal
Computational Heat Transfer and Fluid Dynamics
Previous Article in Journal
An Improved Sparrow Search Algorithm for Global Optimization with Customization-Based Mechanism
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Nonlinear Disturbance Observer-Based Bearing-Only Unmanned Aerial Vehicle Formation Control

College of Electrical and Information Engineering, Hunan University, Changsha 211105, China
*
Author to whom correspondence should be addressed.
Axioms 2023, 12(8), 768; https://doi.org/10.3390/axioms12080768
Submission received: 16 June 2023 / Revised: 30 July 2023 / Accepted: 2 August 2023 / Published: 7 August 2023

Abstract

:
This article primarily investigates nonlinear disturbance observer-based bearing-only formation tracking control for unmanned aerial vehicle (UAV) systems that encounter uncertainties and disturbances. The employed distributed control strategy relies solely on the relative bearing information of neighboring UAVs. To tackle the challenges posed by unknown disturbances and system uncertainties, a novel nonlinear disturbance observer is proposed to effectively mitigate their impact. Moreover, the issue of unknown controller orientation arising from controller singularities is addressed by introducing a Butterworth low-pass filter. This filter ensures a consistent controller gain and enhances disturbance suppression, ultimately transforming the controller gain function into a constant value of 1. Subsequently, a bearing-only formation tracking controller is developed using the backstepping control approach. The stability of the closed-loop control systems is rigorously proven using Lyapunov theory. Finally, numerical simulations are conducted to validate the effectiveness of the proposed scheme in achieving formation control objectives.
MSC:
93A16; 93B53; 93C10; 93D15

1. Introduction

In recent years, the utilization of UAVs has witnessed a remarkable surge in both military and civilian applications, owing to their cost-effectiveness, versatility, and agility [1,2,3]. Nevertheless, as the missions performed by UAVs become increasingly challenging, the capabilities of individual UAVs alone are no longer sufficient to tackle complex tasks. Consequently, researchers worldwide have turned their attention to the cooperative control of multiple UAVs. Multi-UAV systems offer significant advantages in various domains, including area search, rescue operations, and disaster relief. Formation control, which pertains to the coordination of UAVs, plays a vital role in achieving collaborative mission objectives. Unlike the individual tasks of path following [4] or trajectory tracking [5], formation control entails maneuvering UAVs in desired geometric configurations. Nevertheless, this poses a greater challenge as it relies on the limited availability of partial or relative sensing capabilities, as well as the imperative for effective interactions among the UAVs.
Formation tracking control is a highly intricate problem that has been addressed through various approaches documented in the literature [6,7,8,9,10]. Previous studies have categorized formation control problems based on the controlled variables, namely position-based [11,12], displacement-based, distance-based [13], and bearing-based [14,15] formation control. However, recent research has witnessed a rising trend towards coordination tasks accomplished in a distributed manner, leveraging limited information obtained from measurements. This approach offers several advantages, including cost-effectiveness, lightweight design, and simplicity of sensor systems, rendering it highly suitable for practical applications.
Within the realm of distributed formation control, a substantial body of literature has concentrated on augmenting the capabilities of sensor systems relative to other measurement techniques. Notably, bearing measurements have garnered considerable attention owing to their practicality in real-world scenarios, which can be achieved by equipping on-board vision sensors, such as optimal cameras. Generally, bearing measurements are frequently preferred due to their cost-effectiveness and accessibility compared with position measurements and distance measurements.
Considerable research efforts have been dedicated to addressing the challenges associated with the bearing-only formation control problem [16,17,18,19,20]. Zhao et al. [21,22] made significant contributions by developing an infinitesimal bearing rigidity concept and proposing a bearing-only control law. This novel approach ensures not only almost global convergence but also operates effectively in an arbitrary dimensional space. These advancements pave the way for enhanced control strategies in bearing-only formation control research. Li et al. [23] introduced a bearing-only formation tracking control approach for nonholonomic multi-agent systems by integrating the bearing rigidity matrix. In the work conducted by Tang et al. [24], the formation tracking task was accomplished by utilizing the estimated global position, thus eliminating the need for the bearing rigidity assumption. Su et al. [25] introduced a control method based on velocity estimation to address the challenge of leader–follower moving tracking formation control in the presence of unknown reference velocity.
In the realm of formation control, it is important to acknowledge that the prevailing approaches for bearing-only and bearing-based control primarily cater to linear multiagent systems [26,27] characterized by single-integrator [28] or double-integrator models [29]. Nevertheless, this limited applicability prompts a compelling demand for exploring the bearing-only formation control problem within the realm of nonlinear systems, which encompass intricate dynamics, uncertain parameters, and external disturbances. The emergence of UAVs as a significant application domain further accentuates the necessity to tackle the challenge of achieving effective formation control utilizing solely bearing measurements. This article focuses on addressing the formation tracking control problem of UAVs in the presence of parameter uncertainties and external disturbances, relying solely on relative bearing information between UAVs. To accomplish the formation tracking task while satisfying desired relative bearing constraints, an extension of bearing-rigidity graph theory is introduced to effectively handle UAVs formation systems. Moreover, a nonlinear disturbance observer is incorporated to mitigate the effects of system uncertainties and disturbances. Subsequently, a novel bearing-only control approach is proposed for UAVs utilizing the backstepping methodology. The stability of the system is rigorously established through the application of Lyapunov theory. The key contributions of this paper are outlined as follows:
  • A novel approach utilizing a nonlinear disturbance observer to accurately estimate uncertainties and disturbances in system dynamics was proposed. Our control method surpasses the existing approaches [28,29] by effectively addressing the bearing-only formation tracking control problem for UAVs under the influence of uncertainties and disturbances. This problem presents a greater level of complexity compared with the conventional scenarios, such as linear systems and static formations, which have been extensively studied in the literature.
  • The controller design discussed in the paper incorporates considerations for the possible problem of unknown controller orientation arising from controller singularities. It is recognized that singularities can lead to uncertain control directions, which can adversely affect system stability and performance. In order to mitigate this issue, an innovative approach is proposed. By introducing a Butterworth low-pass filter, the unknown controller gain function is transformed into a constant value of 1, ensuring a well-defined and predictable control orientation throughout the operation. This enhancement not only provides greater robustness but also improves the system’s overall control performance and stability, particularly in scenarios where controller singularities are likely to occur.
The structure of the remaining sections in this paper is as follows: Section 2 provides an introduction to the preliminary concepts and presents the problem formulation. Section 3 encompasses the key contributions of this article, including the development of the nonlinear disturbance observer, the bearing-only controller, and the stability analysis of the control system. In Section 4, the simulation results are presented to demonstrate the effectiveness and performance of the proposed approach. Finally, Section 5 concludes the paper by summarizing the findings and highlighting their significance.

2. Preliminaries and Problem Formulation

2.1. Basic Graph Theory

The interaction topology G = ( V , ε ) of the UAV formation system in this article is the leader–follower structure with node set V and edge set ε = V × V . For a leader–follower formation system, the node set V contains node set V f = { n l + 1 , , n } followers and node set V l = { 1 , , n l } leaders. The neighbor set of the ith UAV is expressed as N i = { j V : ( i , j ) ε } . We define the configuration of the UAV formation systems as η = { η 1 , η 2 , , η n } , where η i is the position of the ith UAV. Then, for any edge ( i , j ) ε , the relative displacement vector and relative bearing vector are defined using e ij = η j η i and g ij = e ij / e ij . For the sake of convenience in notation, we employ e k and g k in place of e ij and g ij , respectively, where k = { 1 , 2 , , m } and m is the number of edge. The weighted adjacency matrix of graph G is denoted by A = [ a i j ] R n × n . If there exists an edge between vertices i and j, then the corresponding entry a i j a in the matrix is set to 1; otherwise, a i j is set to 0. Let L = [ l i j ] R n × n denote the Laplacian matrix. If i = j , then the entry l i j = j N i a i j . If i j and ( i , j ) ε , then the entry l i j = a i j . The incidence matrix H = [ h i j ] R m × n for the undirected oriented graph is defined as a matrix consisting of 0, 1, and −1, where rows and columns represent edges and vertices, respectively. If vertex i is the head of edge k , ( k = 1 , 2 , , m ) , then the entry H k i is set to 1. If vertex i is the tail of edge k, then the entry H k i is set to −1. If neither condition is met, the entry H k i is set to 0.For the symbols and notation used in this paper, please refer to Table 1.

2.2. Background Knowledge

Before introducing the lemma regarding the uniqueness of the target formation, we establish the definition of the orthogonal projection matrix for the relative bearing vector g i j as follows:
P g ij = I d g ij g ij T R d × d , ( i , j ) ε
Subsequently, the bearing Laplacian matrix, denoted as B R d n × d n , is defined as follows:
[ B i j ] = 0 d × d , i j , ( i , j ) ε P g i j * , i j , ( i , j ) ε k N i P g i k * , i = j , i ε
Based on the partition of the leader and follower UAVs, we can divide matrix B into the following parts:
B = B l l B l f B f l B f f
where B l l R d n l × d n l , B f f R d n f × d n f , B l f R d n l × d n f , and B f l R d n f × d n l .
The bearing rigidity matrix is defined as the Jacobian of the following bearing function:
R ( p ) = g / η = diag ( P g k / e k ) H ¯ R d m × d n
Lemma 1 
(Zhao et al. [30]). If the number of leaders is greater than or equal to two ( n l 2 ) and matrix B f f is nonsingular, then the desired target formation is guaranteed to be unique. This implies that the target configuration η * = { η 1 * , η 2 * , , η n * } can be uniquely determined using the desired relative bearing g i j * , ( i , j ) ε .

2.3. System Model and Problem Formulation

In UAV formation control, speed and position emerge as crucial control elements. As a result, the formation control design can be delineated into an inner/outer loop structure. The inner loop predominantly functions for attitude control, while the outer loop targets position and velocity tracking. In this paper, our attention primarily falls on the outer-loop control. Consequently, the dynamic model of the UAV can be approximately delineated by a double integrator [31]. To adequately underscore the effects of system uncertainties and disturbances, the dynamic model of the UAV, as presented in this paper, is delineated as follows:
η ˙ i = v i v ˙ i = f i ( η i , v i ) + b i ( η i , v i ) u i + Δ i , i V f
where η i = [ η i 1 η i 2 η i 3 ] T and v i = [ v i 1 v i 2 v i 3 ] T are the position and velocity vector of UAV i in a global framework { X , O , Y } respectively, and u i R 3 denotes the control input. The functions f i ( η i , v i ) and b i ( η i , v i ) are assumed to be unknown smooth functions, while Δ i = Δ f i + Δ b i u i + d i , Δ f i and Δ b i encompass all uncertain functions resulting from parameter uncertainties. Additionally, d i denotes a bounded external perturbation term.
The presence of the unknown smooth function b i ( η i , v i ) can introduce singularity issues in the controller design process, thereby making the control direction of the controlled plant uncertain. To address the issue of unknown control direction, Equation (2) can be rewritten in the following form:
v ˙ i = f i ( η i , v i ) + ( b i ( η i , v i ) 1 ) u i + Δ i + u i = D i + u i
where D i = f i ( η i , v i ) + ( b i ( η i , v i ) 1 ) u i + Δ i . By employing a suitable transformation, the unknown gain associated with the control direction can be effectively adjusted to a value of 1. It should be noted that the total uncertain term D i contains the control input, which leads to the algebraic loop problem in the controller design. In order to avoid the algebraic loop problem, a Butterworth low-pass filter (LFP) was introduced. The above equation can be rewritten as
v ˙ i = f i ( η i , v i ) + ( b i ( η i , v i ) 1 ) u i f + Δ i + Δ M i + u i
where E i = f i ( η i , v i ) + ( b i ( η i , v i ) 1 ) u i f + Δ i + Δ M i is the filtered signal of LFP, which is utilized to mitigate the algebraic loop problem, while Δ M i = ( b i ( η i , v i ) 1 ) u i ( b i ( η i , v i ) 1 ) u i f . The dynamical model of the UAV can be succinctly expressed as follows:
η ˙ i = v i v ˙ i = E i + u i , i V f
where E i = f i ( η i , v i ) + ( b i ( η i , v i ) 1 ) u i f + Δ i + Δ M i represents the cumulative disturbance, which will be estimated by a nonlinear disturbance observer later on.
The bearing-based formation control problems are stated as follows:
Problem 1 (Bearing-based formation tracking): Design the control input u i for the followers to enable the UAV formation systems to track a desired velocity v 0 and simultaneously maintain the desired formation shape, that is, lim t g k g k * and lim t v i v 0 , i V f .

3. Nonlinear Disturbance Observer-Based Bearing-Only Formation Control

3.1. Bearing-Only Formation Control

In this subsection, we present a novel control law for bearing-defined formation control, which integrates a nonlinear disturbance observer and the backstepping control method. This approach aims to address problem 1 effectively.
According to the dynamical model described in Equation (5), we propose the following innovative nonlinear disturbance observer to handle the uncertainties.
v ^ ˙ i = E ^ i + u i f E ^ ˙ i = r i 2 ( m i 1 sinh ( m i 2 ( v ^ i v i ) ) m i 3 sinh ( m i 4 E ^ i / r i ) ) , i V f
where E ^ i and v ^ i represent the estimated values of the disturbance term E i and velocity v i , respectively. m i 1 , m i 2 , m i 3 , and m i 4 are non-negative real parameters, and their values can be chosen by referring to [32].
If T > 0 , we have
lim r i 0 T v ^ i v i d t = 0
Then, v ^ i v i . According to (4) and (6), we have E ^ i E i and
E i = f i ( η i , v i ) + ( b i ( η i , v i ) 1 ) u i f + Δ i + Δ M i = E ^ i + σ i
where σ i denotes the estimation error.
Next, we integrate the nonlinear disturbance observer and backstepping control strategy to design a bearing-only formation controller.
Firstly, define the following function:
V i j = ( g i j g i j * ) T ( g i j g i j * ) , ( i , j ) ε
Computing the partial derivatives with respect to the e k direction yields
V i j e i j = ( g i j g i j * ) T P g i j ( v i v 0 + v 0 v j ) / e i j = ( g i j g i j * ) T P g i j ( v ˜ i v ˜ j ) / e i j
Step 1: Consider the following Lyapunov candidate function [33]:
V 1 = i = 1 n j N i V i j = i = 1 n j N i ( ( g i j g i j * ) T ( g i j g i j * ) )
The derivative of the above equation gives
V ˙ 1 = V 1 e i j T e i j t = 2 i = 1 n j N i ( g i j g i j * ) T P g i j ( v i v j ) / e i j = 2 i = 1 n j N i ( g i j g i j * ) T P g i j ( v ˜ i v ˜ j ) / e i j
Since the interaction topology is an undirected graph, the above equation can be written as
V ˙ 1 = i = 1 n j N i ( g i j g i j * ) T P g i j v ˜ i / e i j + i = 1 n j N i ( g i j g i j * ) T P g i j v ˜ j / e i j = 2 i = 1 n j N i ( g i j g i j * ) T P g i j v ˜ i / e i j
Now, we introduce the following auxiliary virtual control law:
α s i = k 1 j N i P g i j T ( g i j g i j * ) / e i j , i v f
where k 1 is a positive constant designed parameter. Equation (14) can be expressed in a compact form as follows:
α s = K 1 R T g ˜
where K 1 = diag ( ( k 1 , , k 1 ) , g ˜ = [ g ˜ 1 , g ˜ 2 , , g ˜ m ] T , g ˜ k = g k g k * , k = ( 1 , 2 , , m ) .
It is important to note that the controller design in the problem needs to satisfy the bearing-only condition. Upon careful examination, it becomes evident that the virtual control variable incorporates the distance norm e i j , which is not accessible in the controller design. To address this issue, a modification is proposed to adjust the virtual control variable as
α s = K 1 R ^ T g ˜
where R ^ = diag ( P g k ) H ¯ without the distance norm e i j .
Step 2: Define the following available auxiliary error:
s i = v ˜ i α s i
According to Equation (4), the derivative of auxiliary error can be written as
s ˙ i = f i ( η i , v i ) + ( b i ( η i , v i ) 1 ) u i f + Δ i + Δ M i + u i α ˙ s i
Then, select the following Lyapunov candidate function:
V 2 = V 1 + 1 2 i = n l + 1 n s i T s i
By (13) to (18), the derivative of V 2 yields
V ˙ 2 = 2 K 1 g ˜ T R ^ R ^ T g ˜ + 2 g ˜ T R ^ s + i = n l + 1 n s i T ( E i + u i v ˙ 0 α ˙ s i )
Then, the bearing-only formation control is designed as follows:
u i = k 2 s i + α ˙ s i 2 j N i P g i j T ( g i j g i j * ) s i E ^ i + v ˙ 0
where k 2 is a positive constant designed parameter.
Then, the nonlinear disturbance observer-based bearing-only formation control law is proposed as
u i = k 2 s i + α ˙ s i 2 j N i P g i j T ( g i j g i j * ) s i E ^ i + v ˙ 0 α s i = k 1 j N i P g i j T ( g i j g i j * ) v ^ ˙ i = E ^ i + u i f E ^ ˙ i = r i 2 ( m i 1 sinh ( m i 2 ( v ^ i v i ) ) m i 3 sinh ( m i 4 E ^ i / r i ) , i V f
The schematic diagram of the proposed control strategy is shown in Figure 1.

3.2. Stability Analysis

In Section 3.1, we can observe that the estimation error of the disturbance observer (6) remains bounded at all times. Thus, E i E ^ I σ m , t 0 , where σ m is a positive constant representing the maximum value of the estimation error of the nonlinear disturbance observer. Therefore, it is reasonable to transform the original problem 1 into designing a formation tracking control law ensuring that the formation tracking error g ˜ k and v ˜ i can converge to a small neighborhood of zero.
The main result is given as follows:
Theorem 1. 
Under Assumption A1, Assumption A2 and Assumption A3 (see Appendix A for details), we consider a group of UAVs with the system dynamics given by Equation (2). The bearing-only formation control inputs u i are determined using Equation (21), with virtual control defined by Equation (16), and the nonlinear disturbance observer is given by Equation (6). With these conditions, problem 1 can be successfully addressed, demonstrating that the formation tracking error g ˜ k and v ˜ i can converge to a small neighborhood of zero.
Proof of Theorem 1. 
By substituting the control law (21) into Equation (20), we obtain
V ˙ 2 = 2 K 1 g ˜ T R ^ R ^ T g ˜ K 2 s T s + g ˜ T R ^ s + i = n l + 1 n s i T σ i 2 K 1 λ m ( R ^ R ^ T ) g ˜ T g ˜ K 2 s T s + i = n l + 1 n s i T σ i
where K 2 = diag ( k 2 , k 2 , , k 2 ) .
By applying Young’s inequality, we can establish the following inequality:
s i T σ i s i / 2 + σ i / 2 s i / 2 + σ m / 2
Substituting Equation (24) into Equation (23), we obtain
V ˙ 2 2 K 1 λ m ( R ^ R ^ T ) g ˜ T g ˜ K 2 s T s + i = n l + 1 n s i / 2 + ( n n l 1 ) σ m / 2 2 α V 2 + ( n n l 1 ) σ m / 2
where α = min { 2 k 1 λ m ( R ^ R ^ T ) , ( k 2 1 / 2 ) } .
By solving the above inequality, we obtain
0 V 2 ( t ) φ / ( 2 α ) + ( V 2 ( 0 ) φ / ( 2 α ) e 2 α t
where φ = ( n n l 1 ) σ m / 2 .
Based on the inequality (26), it can be determined that the Lyapunov function V 2 is bounded by φ / ( 2 α ) . This implies that all signals of the control systems are uniformly ultimately bounded (UUB). It is worth noting that by increasing α , the upper bound φ / ( 2 α ) can be decreased. This means that formation tracking error g ˜ k and v ˜ i can be compelled to converge to a compact set around zero. Consequently, the proof of Theorem 1 is completed. □

4. Simulation Examples

In the simulation experiments, we conducted three distinct cases to evaluate the performance of the proposed controller. The first case aimed to verify the effectiveness of the controller in scenarios involving static formation control, constant velocity formation tracking control, and time-varying velocity formation tracking control. By examining these different control scenarios, we assessed the controller’s ability to achieve accurate and stable control under various conditions. The second case focused on testing the robustness of the controller. External perturbations and parameter perturbations were introduced to the control system to assess its ability to withstand disturbances and uncertainties. This case allowed us to evaluate the controller’s resilience and its capability to maintain control performance in the presence of external disturbances and parameter variations. The third case in this study aimed to validate the superiority of the proposed control method by comparing it with a traditional PD bearing-only formation method.
The formation shape depicted in Figure 2a represents a cube, comprising two leaders (highlighted in red) and six followers (highlighted in blue). The corresponding topology structure is illustrated in Figure 2b. The relative desired bearing values for the target formation are as follows: g 32 * = g 41 * = g 76 * = g 85 * = [ 1 0 0 ] T , g 32 * = g 64 * = [ 1 / 2 3 / 2 ] T , g 51 * = g 62 * = g 73 * = g 84 * = [ 0 0 1 ] T , g 82 * = 1 / 3 [ 1 1 1 ] T , and other relative bearing information can be obtained using g i j * = g i j * , ( i , j ) ε .
The formation shape depicted in Figure 3a represents a pentagon, consisting of two leaders (highlighted in red) and four followers (highlighted in blue). The corresponding topology structure is illustrated in Figure 3b. The relative desired bearing values for the target formation are as follows: g 12 * = g 34 * = g 56 * = [ 1 0 ] T , g 32 * = g 64 * = [ 1 / 2 3 / 2 ] T , g 41 * = g 53 * = [ 1 / 2 3 / 2 ] T , g 31 * = g 54 * = 3 / 2 1 / 2 T , g 36 * = [ 3 / 2 1 / 2 ] T , and other relative bearing information can be obtained using g i j * = g i j * , ( i , j ) ε .

4.1. Case 1: Bearing-Only Formation Control for UAVs

In this subsection, we conduct simulation experiments to evaluate the performance of the proposed formation tracking control strategies for UAVs. The experiments were carried out in three scenarios: static formation tracking, constant velocity formation tracking, and time-varying velocity formation tracking. The system model of UAVs is depicted as follows:
η ˙ i = v i v ˙ i = cos ( u i ) + u i + f i ( η i , v i ) + d i , i V f
where
f i ( η i , v i ) = [ 2 η i 1 + 2 v i 1 sin ( t ) , 2 η i 2 + 2 v i 2 cos ( t ) , 2 η i 3 + 2 v i 3 sin 2 ( t ) ] T
and d i = [ 0 , 0 , 0 ] T , indicating the absence of external disturbances in the control systems. The control parameters are selected as k 1 = 90 , k 2 = 10 , r i = 100 , m i 1 = 5 , m i 2 = m i 3 = m i 4 = 2 , i = 3 , 4 , , 8 .
In the static formation simulation, the initial position and the velocity of the leaders are η 1 ( 0 ) = [ 4 0 4 ] T , η 2 ( 0 ) = [ 4 4 4 ] T , v 1 ( 0 ) = v 2 ( 0 ) = [ 0 0 0 ] T , respectively. The initial positions of the followers η 3 ( 0 ) = [ 3 7 6 ] T , η 4 ( 0 ) = [ 4 3 9 ] T , η 5 ( 0 ) = [ 7 3 3 ] T , η 6 ( 0 ) = [ 6 2 3 ] T , η 7 ( 0 ) = [ 3 5 4 ] T , η 8 ( 0 ) = [ 0 3 2 ] T , while their velocities are set to zero. The simulation results are shown in Figure 4.
In the constant velocity formation tracking simulation, the initial position and the velocity of the leaders are η 1 ( 0 ) = [ 4 0 4 ] T , η 2 ( 0 ) = [ 4 4 4 ] T , v 1 ( 0 ) = v 2 ( 0 ) = [ 1 0 0 ] T , respectively. The initial positions of the followers are randomly selected, while their velocities are set to zero. The simulation results are shown in Figure 5.
In the time-varying velocity formation tracking simulation, the initial position and the velocity of the leaders are η 1 ( 0 ) = [ 4 0 4 ] T , η 2 ( 0 ) = [ 4 4 4 ] T , v 1 ( 0 ) = v 2 ( 0 ) = [ 3 sin ( 2 π t / 20 ) 0 1 ] T , respectively. The initial positions of the followers are randomly selected, while their velocities are set to zero. The simulation results are shown in Figure 6.
Based on the simulation results, it can be concluded that the proposed approach successfully accomplishes the static formation, constant velocity tracking formation, and time-varying formation control missions. The bearing errors and velocity estimation errors exhibit convergence to zero, indicating the effectiveness of the approach.

4.2. Case 2: Bearing-Only Formation Control with Uncertainties and Disturbance

In this subsection, simulation experiments were conducted to assess the validity of the proposed bearing-only formation control approach in handling uncertainties and disturbances. The equations describing the UAV system are presented in Equation (2), with the distinction that the system incorporates parametric perturbations and external disturbances. The desired bearing and controller parameters remain unchanged from Section 4.1.
In the formation simulation with external disturbance, the initial position and the velocity of the leaders are η 1 ( 0 ) = [ 4 0 4 ] T , η 2 ( 0 ) = [ 4 4 4 ] T , v 1 ( 0 ) = v 2 ( 0 ) = [ 1 1 1 ] T , respectively. The initial positions of the followers are randomly selected, while their velocities are set to zero. At the 10th second of the simulation, an external disturbance, denoted as
d i = [ 0 , 0 , 0 ] T , t 0 d i = [ 10 sin ( t ) , 10 sin ( t ) , 10 sin ( t ) ] T , t > 10
impacts the system. The simulation results are shown in Figure 7a,c.
In this simulation, the system is not subjected to external perturbations. Instead, it experiences parameter perturbations, as follows:
f i ( η i , v i ) = [ 2 η i 1 + 2 v i 1 sin ( t ) , 2 η i 2 + 2 v i 2 cos ( t ) , 2 η i 3 + 2 v i 3 sin 2 ( t ) ] T , t 10 f i ( η i , v i ) = [ 10 η i 1 + 2 v i 1 sin ( t ) , 10 η i 2 + 2 v i 2 cos ( t ) , 10 η i 3 + 2 v i 3 sin 2 ( t ) ] T , t > 10
The simulation results are shown in Figure 7b,d.
Based on the simulation results, it can be observed that the control system exhibits slight jitter in the velocity tracking error and bearing error when subjected to uncertainties and external disturbances. However, the system quickly converges to zero, indicating that the proposed method in this paper effectively handles system uncertainties and disturbances with robustness.

4.3. Case 3: Comparison Simulation

In this subsection, the superiority of the controller proposed in this paper is verified via comparative simulations, mainly by comparing the control performance indexes of the control system. By conducting simulation experiments, the performance differences between the proposed controller and other methods can be evaluated and compared. These performance metrics include the stability, convergence speed, and robustness of the system. In the cited literature [22], the leader–follower formation strategy is employed, and a PD controller utilizing bearing information is devised for the double integral model to accomplish the objective of tracking the desired formation. As stated in the same literature [22], the control input for each follower is given in
u i = k p j N i ( g i j g i j * ) + k d g ˙ i j , i V f
where k p and k d are control parameters.
Given that the PD controller was specifically developed to address the formation tracking issue associated with the double integral model, it is not capable of handling the complex and nonlinear UAV formation tracking problem. Consequently, the system model of UAVs is represented as follows:
η ˙ i = v i v ˙ i = u i + d i , i V f
where d i R 2 , indicating the absence of external disturbances in the control systems and η i , v i R 2 . It is important to note that the model in (31) does not incorporate the unknown nonlinear functions f1 and b of the system. It solely takes into account the external perturbation d for the purpose of comparing the system’s resilience. Furthermore, the model is limited to a second-order system, focusing exclusively on the motion in the x–y-axes and neglecting the vertical motion in the z-axis.
The desired formation structure and topology structure are shown in Figure 3. The control parameters for the proposed controller are k 1 = 90 , k 2 = 10 , r i = 100 , m i 1 = 5 , m i 2 = m i 3 = m i 4 = 2 , i = 3 , 4 , , 6 . The controller parameters for the PD control method are k p = 98.7 and k d = 87.4 . The initial position and the velocity of the leaders are η 1 ( 0 ) = [ 1 1 ] T , η 2 ( 0 ) = [ 3 1 ] T , v 1 ( 0 ) = v 2 ( 0 ) = [ 1 1 ] T , respectively. The initial positions of the followers are η 3 ( 0 ) = [ 2 1 ] T , η 4 ( 0 ) = [ 3 1 ] T , η 5 ( 0 ) = [ 0 2 ] T , and η 6 ( 0 ) = [ 3 3 ] T , while their velocities are set to zero. At the 10th second of the simulation, an external disturbance, denoted as
d i = [ 0 , 0 ] T , t 0 d i = [ 1 , 1 ] T , t > 10
impacts the systems.
The comparative simulation results are shown in Figure 8, and a comparison of the control performance index parameters is given in Table 2. Before delving into the analysis of the results, it is essential to clarify that the convergence time (CT) is defined as the duration needed for the error to diminish to a value below 0.01.
Based on the simulation results, it is evident that both control approaches can successfully accomplish the formation tracking objective. However, when subjected to an external disturbance at the 10th second, the PD control system exhibits oscillations, while the controller proposed in this paper effectively rectifies the situation by applying a more suitable control input within a shorter duration, thereby rapidly converging towards the equilibrium point. Table 2 clearly demonstrates that the controller proposed in this paper outperforms the PD controller in terms of mean square error and convergence speed. Moreover, the proposed controller exhibits faster convergence even when subjected to perturbations, showcasing its robustness and superior performance.

5. Conclusions

This article presents a study on nonlinear disturbance observer-based bearing-only formation tracking control for UAV systems. The distributed control strategy utilized in the research relies on relative bearing information from neighboring UAVs. The article addresses the challenges posed by uncertainties and disturbances by introducing a novel nonlinear disturbance observer, which effectively mitigates their impact. Additionally, the problem of an unknown controller orientation is resolved through the implementation of a Butterworth low-pass filter. The proposed approach employs a backstepping control method to develop a bearing-only formation tracking controller. The stability of the closed-loop control systems is rigorously proven using Lyapunov theory. Numerical simulations are conducted to validate the effectiveness of the proposed scheme in achieving the objectives of formation control. Overall, this research contributes to the advancement of UAV systems by providing a robust control strategy for formation tracking in the presence of uncertainties and disturbances.

Author Contributions

Conceptualization, writing—original draft preparation, simulation results, and theoretical contribution, C.D.; supervision, project administration, and funding acquisition, J.Z.; writing—review and editing, C.D. and Z.Z. All authors have read and agreed to the published version of the manuscript.

Funding

This study was supported by China Postdoctoral Science Special Foundation (Grant Number: 2021TQ0102), National Natural Science Foundation of China (Grant Number: 62203158, Changsha Natural Science Foundation (Grant Number: kq2202175) and National Natural Science Foundation of Hunan Province (Grant Number: 2023JJ40182).

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

Appendix A

Assumption A1. 
Graph G is assumed to be connected, and the submatrix B f f is assumed to be nonsingular.
Remark A1. 
Assumption A1 plays a crucial role in addressing the bearing-based formation control problem, as it ensures that only unique formations can be achieved through control approaches. Only when the bearing-based formation is unique can the desired position and velocity of each follower be determined with certainty. Lemma 1 further establishes the requirement for the submatrix B f f to be nonsingular.
Assumption A2 (Collision Avoidance). 
Using the evolution of the formation, neighboring agents maintain a safe distance to avoid colliding with each other. This implies that for all pairs of agents ( i , j ) ε and for all time t 0 , the positions of the agents satisfy the condition η i ( t ) η j ( t ) , and the Euclidean distance between the positions of agents i and j, denoted as η i ( t ) η j ( t ) , is greater than or equal to a positive constant d m , which represents the minimum safe distance.
Remark A2. 
Assumption A2, which is commonly adopted in existing formation control studies [15], reflects the importance of collision avoidance. Those who are interested in delving into this topic can refer to the literature [34] for further exploration.
Assumption A3. 
The first and second leaders of the multi-agent systems naturally follow the desired tracking trajectory without any control input, meaning that their positions η 1 = η 1 * , η 2 = η 2 * , where η 1 * and η 2 * are the desired position of the leaders, and their velocities v 1 and v 2 are equal to the desired velocity v 0 .

References

  1. Wu, Y.; Gou, J.; Hu, X.; Huang, Y. A new consensus theory-based method for formation control and obstacle avoidance of UAVs. Aerosp. Sci. Technol. 2020, 107, 106332. [Google Scholar] [CrossRef]
  2. Dou, L.; Cai, S.; Zhang, X.; Su, X.; Zhang, R. Event-triggered-based adaptive dynamic programming for distributed formation control of mul-ti-UAV. J. Frankl. Inst. 2022, 359, 3671–3691. [Google Scholar] [CrossRef]
  3. Wei, L.; Chen, M.; Li, T. Dynamic event-triggered cooperative formation control for UAVs subject to time-varying disturbances. IET Control Theory Appl. 2020, 14, 2514–2525. [Google Scholar] [CrossRef]
  4. Wang, S.; Yan, X.; Ma, F.; Wu, P.; Liu, Y. A novel path following approach for autonomous ships based on fast marching method and deep reinforcement learning. Ocean Eng. 2022, 257, 111495. [Google Scholar] [CrossRef]
  5. Zhao, Z.; Cao, D.; Yang, J.; Wang, H. High-order sliding mode observer-based trajectory tracking control for a quadrotor UAV with uncertain dynamics. Nonlinear Dyn. 2020, 102, 2583–2596. [Google Scholar] [CrossRef]
  6. Cao, L.; Yao, D.; Li, H.; Meng, W.; Lu, R. Fuzzy-based dynamic event triggering formation control for nonstrict-feedback nonlinear MASs. Fuzzy Sets Syst. 2023, 452, 1–22. [Google Scholar] [CrossRef]
  7. Chen, G.; Yao, D.; Zhou, Q.; Li, H.; Lu, R. Distributed event-triggered formation control of USVs with prescribed performance. J. Syst. Sci. Complex. 2022, 35, 820–838. [Google Scholar] [CrossRef]
  8. Fu, M.; Wang, L. A fixed-time distributed formation control of marine surface vehicles with actuator input saturation and time-varying ocean currents. Ocean Eng. 2022, 251, 111067. [Google Scholar] [CrossRef]
  9. Zhi, Y.; Liu, L.; Guan, B.; Wang, B.; Cheng, Z.; Fan, H. Distributed robust adaptive formation control of fixed-wing UAVs with unknown uncertainties and disturbances. Aerosp. Sci. Technol. 2022, 126, 107600. [Google Scholar] [CrossRef]
  10. Ziquan, Y.; Zhang, Y.; Jiang, B.; Jun, F.; Ying, J. A review on fault-tolerant cooperative control of multiple unmanned aerial vehicles. Chin. J. Aeronaut. 2022, 35, 1–18. [Google Scholar]
  11. Xu, Z.; Yan, T.; Yang, S.X.; Gadsden, S.A. Distributed Leader Follower Formation Control of Mobile Robots based on Bioinspired Neural Dynamics and Adaptive Sliding Innovation Filter. IEEE Trans. Ind. Inform. 2023; in press. [Google Scholar] [CrossRef]
  12. Wei, H.; Shen, C.; Shi, Y. Distributed Lyapunov-based model predictive formation tracking control for autonomous underwater vehicles subject to disturbances. IEEE Trans. Syst. Man Cybern. Syst. 2019, 51, 5198–5208. [Google Scholar] [CrossRef]
  13. He, S.; Xu, R.; Zhao, Z.; Zou, T. Vision-based neural formation tracking control of multiple autonomous vehicles with visibility and performance constraints. Neurocomputing 2022, 492, 651–663. [Google Scholar] [CrossRef]
  14. Van Tran, Q.; Kim, J. Bearing-constrained formation tracking control of nonholonomic agents without inter-agent communication. IEEE Control Syst. Lett. 2022, 6, 2401–2406. [Google Scholar] [CrossRef]
  15. Su, H.; Zhu, S.; Yang, Z.; Chen, C.; Guan, X. Bearing-based formation tracking control of AUVs with optimal gains tuning. Ocean Eng. 2022, 258, 111672. [Google Scholar] [CrossRef]
  16. Chen, L.; Sun, Z. Gradient-based bearing-only formation control: An elevation angle approach. Automatica 2022, 141, 110310. [Google Scholar] [CrossRef]
  17. Luo, X.; Li, X.; Li, X.; Guan, X. Bearing-only formation control of multi-agent systems in local reference frames. Int. J. Control 2021, 94, 1261–1272. [Google Scholar] [CrossRef]
  18. Wu, K.; Hu, J.; Lennox, B.; Arvin, F. Finite-time bearing-only formation tracking of heterogeneous mobile robots with collision avoidance. IEEE Trans. Circuits Syst. II Express Briefs 2021, 68, 3316–3320. [Google Scholar] [CrossRef]
  19. Zhao, J.; Yu, X.; Li, X.; Wang, H. Bearing-only formation tracking control of multi-agent systems with local reference frames and con-stant-velocity leaders. IEEE Control Syst. Lett. 2020, 5, 1–6. [Google Scholar] [CrossRef]
  20. Bae, Y.B.; Kwon, S.H.; Lim, Y.H.; Ahn, H.S. Distributed bearing-based formation control and network localization with exogenous disturbances. Int. J. Robust Nonlinear Control 2022, 32, 6556–6573. [Google Scholar] [CrossRef]
  21. Zhao, S.; Zelazo, D. Bearing rigidity and almost global bearing-only formation stabilization. IEEE Trans. Autom. Control 2015, 61, 1255–1268. [Google Scholar] [CrossRef] [Green Version]
  22. Zhao, S.; Li, Z.; Ding, Z. Bearing-only formation tracking control of multiagent systems. IEEE Trans. Autom. Control 2019, 64, 4541–4554. [Google Scholar] [CrossRef] [Green Version]
  23. Li, X.; Wen, C.; Fang, X.; Wang, J. Adaptive bearing-only formation tracking control for nonholonomic multiagent systems. IEEE Trans. Cybern. 2021, 52, 7552–7562. [Google Scholar] [CrossRef]
  24. Tang, Z.; Loría, A. Localization and tracking control of autonomous vehicles in time-varying bearing formation. IEEE Control Syst. Lett. 2022, 7, 1231–1236. [Google Scholar] [CrossRef]
  25. Su, H.; Chen, C.; Yang, Z.; Zhu, S.; Guan, X. Bearing-Based Formation Tracking Control with Time-Varying Velocity Estimation. IEEE Control Syst. Lett. 2022; in press. [Google Scholar] [CrossRef]
  26. Amirkhani, A.; Barshooi, A.H. Consensus in multi-agent systems: A review. Artif. Intell. Rev. 2022, 55, 3897–3935. [Google Scholar] [CrossRef]
  27. Bao, G.; Ma, L.; Yi, X. Recent advances on cooperative control of heterogeneous multi-agent systems subject to constraints: A survey. Syst. Sci. Control Eng. 2022, 10, 539–551. [Google Scholar] [CrossRef]
  28. Li, Z.; Tnunay, H.; Zhao, S.; Meng, W.; Xie, S.Q.; Ding, Z. Bearing-only formation control with prespecified convergence time. IEEE Trans. Cybern. 2020, 52, 4620–4629. [Google Scholar] [CrossRef]
  29. Zhao, J.; Li, X.; Yu, X.; Wang, H. Finite-time cooperative control for bearing-defined leader-following formation of multiple dou-ble-integrators. IEEE Trans. Cybern. 2021, 52, 13363–13372. [Google Scholar] [CrossRef]
  30. Zhao, S.; Zelazo, D. Localizability and distributed protocols for bearing-based network localization in arbitrary dimensions. Automatica 2016, 69, 334–341. [Google Scholar] [CrossRef] [Green Version]
  31. Dong, X.; Yu, B.; Shi, Z.; Zhong, Y. Time-varying formation control for unmanned aerial vehicles: Theories and applications. IEEE Trans. Control Syst. Technol. 2014, 23, 340–348. [Google Scholar] [CrossRef]
  32. Bu, X.; Wu, X.; Zhang, R.; Ma, Z.; Huang, J. Tracking differentiator design for the robust backstepping control of a flexible air-breathing hy-personic vehicle. J. Frankl. Inst. 2015, 352, 1739–1765. [Google Scholar] [CrossRef]
  33. Li, X.; Wen, C.; Chen, C. Adaptive formation control of networked robotic systems with bearing-only measurements. IEEE Trans. Cybern. 2020, 51, 199–209. [Google Scholar] [CrossRef]
  34. Mondal, A.; Bhowmick, C.; Behera, L.; Jamshidi, M. Trajectory tracking by multiple agents in for-mation with collision avoidance and connectivity assurance. IEEE Syst. J. 2017, 12, 2449–2460. [Google Scholar] [CrossRef]
Figure 1. The schematic diagram of the proposed bearing-only formation control strategy.
Figure 1. The schematic diagram of the proposed bearing-only formation control strategy.
Axioms 12 00768 g001
Figure 2. The desired formation structure (a) and topology structure (b) for case 1 and case 2.
Figure 2. The desired formation structure (a) and topology structure (b) for case 1 and case 2.
Axioms 12 00768 g002
Figure 3. The desired formation structure (a) and topology structure (b) for case 3.
Figure 3. The desired formation structure (a) and topology structure (b) for case 3.
Axioms 12 00768 g003
Figure 4. Trajectories (a), bearing error (b), and velocity error (c) of the proposed formation control method for static formation case. The bearing error ( i , j ) ε g i j g i j * .
Figure 4. Trajectories (a), bearing error (b), and velocity error (c) of the proposed formation control method for static formation case. The bearing error ( i , j ) ε g i j g i j * .
Axioms 12 00768 g004
Figure 5. Trajectories (a), bearing error (b), and velocity error (c) of the proposed formation control method for the constant velocity formation case. The bearing error ( i , j ) ε g i j g i j * .
Figure 5. Trajectories (a), bearing error (b), and velocity error (c) of the proposed formation control method for the constant velocity formation case. The bearing error ( i , j ) ε g i j g i j * .
Axioms 12 00768 g005
Figure 6. Trajectories (a), bearing error (b), and velocity error (c) of the proposed formation control method for the time-varying velocity formation case. The bearing error ( i , j ) ε g i j g i j * .
Figure 6. Trajectories (a), bearing error (b), and velocity error (c) of the proposed formation control method for the time-varying velocity formation case. The bearing error ( i , j ) ε g i j g i j * .
Axioms 12 00768 g006
Figure 7. Trajectories, bearing error, and velocity error of the proposed formation control method with uncertainties and disturbance. (a,c) The tracking formation case with external disturbance. (b,d) The tracking formation case with parameters disturbance. The bearing error ( i , j ) ε g i j g i j * .
Figure 7. Trajectories, bearing error, and velocity error of the proposed formation control method with uncertainties and disturbance. (a,c) The tracking formation case with external disturbance. (b,d) The tracking formation case with parameters disturbance. The bearing error ( i , j ) ε g i j g i j * .
Axioms 12 00768 g007
Figure 8. Trajectories, bearing error, and velocity error of comparative simulation. (a,c) The proposed controller in this article. (b,d) The PD controller. The bearing error ( i , j ) ε g i j g i j * .
Figure 8. Trajectories, bearing error, and velocity error of comparative simulation. (a,c) The proposed controller in this article. (b,d) The PD controller. The bearing error ( i , j ) ε g i j g i j * .
Axioms 12 00768 g008
Table 1. Notations and symbols.
Table 1. Notations and symbols.
Symbols
R, R + Real number and non-negative real numbers
R n , R n × m Set of n × 1 real vectors and n × m real matrices, respectively
Kronecker product
I d Set of d × d identity matrix
λ m ( A ) Minimal eigenvalue of matrix A
A 2-norm of matrix A
Max( A )The largest element of matrix A
RMSRoot mean square
CTConvergence time
V = 1 , 2 , , n Index set of the UAVs
ε = V × V Edge set between the UAVs
N i Neighbor set of UAV i
A = [ a i j ] R n × n Weighted adjacency matrix
L = [ l i j ] R n × n Laplacian matrix
H = [ h i j ] R m × n Incidence matrix
B R d n × d n Bearing Laplacian matrix
R ( η ) R d m × d n Bearing-rigidity matrix
Table 2. Comparison of control performance indicators.
Table 2. Comparison of control performance indicators.
IndexProposed ControllerPD
Without Disturbance ( 0 t < 10 )Input Disturbance ( 10 t 20 )Without Disturbance ( 0 t < 10 )Input Disturbance ( 10 t 20 )
RMS ( i = 3 6 v ˜ i 1 )2.290.12.510.24
RMS ( i = 3 6 v ˜ i 2 )2.150.123.560.56
RMS ( ( i , j ) ε g i j g i j * )0.50.021.080.20
Max (CT( v ˜ i 1 ))1 s10.3 s8.31 s13.2 s
Max (CT( v ˜ i 2 ))0.96 s10.3 s8.8 s14 s
Max (CT( ( i , j ) ε g i j g i j * ))0.8 s10 s5.2 s10 s
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Ding, C.; Zhang, J.; Zhang, Z. Nonlinear Disturbance Observer-Based Bearing-Only Unmanned Aerial Vehicle Formation Control. Axioms 2023, 12, 768. https://doi.org/10.3390/axioms12080768

AMA Style

Ding C, Zhang J, Zhang Z. Nonlinear Disturbance Observer-Based Bearing-Only Unmanned Aerial Vehicle Formation Control. Axioms. 2023; 12(8):768. https://doi.org/10.3390/axioms12080768

Chicago/Turabian Style

Ding, Can, Jing Zhang, and Zhe Zhang. 2023. "Nonlinear Disturbance Observer-Based Bearing-Only Unmanned Aerial Vehicle Formation Control" Axioms 12, no. 8: 768. https://doi.org/10.3390/axioms12080768

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