Abstract
This paper investigates the distance-based formation and cooperative path-following control problems for multiple fixed-wing unmanned aerial vehicles (UAVs). In this study, we design the distance-based formation control structure to achieve the virtual leader and followers pre-defined rigid formation pattern, ensuring simultaneously relative localization. A path-following control strategy based on adaptive dynamic surface and neural network control technology is proposed to approximate the uncertain disturbances of the environment and unmodeled dynamics. And the longitudinal and lateral subsystems’ adaptive fault-tolerant controllers are designed, respectively, to achieve the fault-tolerant control of UAVs’ formation in three-dimensional environments. Furthermore, the adaptive sliding mode controller with an auxiliary controller is designed to realize the UAVs path following with limited input saturation. Finally, simulation examples are given to clarify and verify the effectiveness of the theoretical results.
1. Introduction
In recent years, unmanned aerial vehicle (UAV) formation has attracted numerous research interests due to their advantages of high efficiency, low cost, functional complementarity, scalability, and so on [1,2]. For UAV formation systems, reliable and efficient formation control technology is crucial. Path following of UAVs refers to the control problem of multiple UAVs tracking a specified flight path in a certain geometric configuration, which has a wide range of application prospects in reconnaissance, electronic jamming, and other combat missions [3,4].
The cooperative path-following of multiple UAVs has received a lot of attention from many researchers in recent years due to their increasing need in the civil and military fields [5]. Unlike trajectory tracking control, path-following control (PFC) is a kind of static tracking that does not consider time and emphasizes geometric position relationships, as the UAV tracks a parametric path with a certain control accuracy under the action of a controller. PFC can be generally applied to UAVs for reconnaissance, obstacle avoidance, terrain tracking, and other tasks. For the problem of the cooperative PFC of multiple UAVs, a large number of research results have emerged in recent years. Methods commonly used to achieve PFC include backstepping [6,7,8], model predictive control [9,10,11], feedback linearization [12,13], sliding mode control [14,15,16,17,18,19,20,21], adaptive robust control [22], and so on.
The authors in [23] proposed that most of the existing literature uses the backstepping method to solve the problem of PFC. The good control performance of controllers based on the backstepping method is sufficient to provide a performance reference for other types of controllers. The authors in [7] improved the controller by estimating the external disturbance to mitigate the effect of external disturbances, and the experimental results verified the robustness of the designed controller. The PFC problem of multi-UAV cooperative transportation was studied in [8], and these authors verified that the control system has high path-following accuracy and low cooperative error through numerical simulation. In [24], the cooperative PFC problem of fixed-wing UAVs was investigated, and the control scheme effectively realized the path following of a desired configuration. In [25], the asymptotic stability of the closed-loop system for the multi-UAV cooperative PFC problem was studied under constraints. In [26], a hybrid higher-order controller was used to solve the cooperative PFC problem for fixed-wing UAVs with speed constraints. In [27], a continuous nonlinear robust control method with bounded unknown disturbances was proposed to achieve a distributed time-varying formation control of UAVs in the two-dimensional space. Although some research progress has been made in the research of PFC for UAV formation, there are still large gaps in actual applications, and there are still many problems to be solved in dealing with complex electromagnetic environments, sudden failures, control input saturation, and unknown external disturbances.
In order to achieve UAV formation control, we need to consider the perception capabilities of individual UAVs and the interaction capabilities between UAVs, whose variables need to be sensed and whose states need to be actively controlled to realize the desired formation. The authors in [12] classified formation control into three control schemes: position-based, displacement-based, and distance-based. Ren et al. proposed a position-based formation control strategy using a double integral model [28], which requires agents to carry more advanced sensing equipment. In displacement-based formation control, individuals achieve the formation configuration by controlling their relative displacement (distance and direction) from neighbors in the global coordinate system. In distance-based formation control, individuals actively control their distance from neighbors to form the desired formation configuration, and individuals only need to perceive their relative distance from neighbors based on their local coordinate system [29,30]. The main advantage of this scheme is that it requires less global information than position-based and displacement-based control schemes.
The distance-based formation control was introduced by Cai [31], Dorfler [32], Krick [33], and Oh.K.K [34]. Babazadeh et al. developed the distance-based formation tracking algorithm using the Riccati equation with constraints [35]. Cai et al. proposed the distance-based formation controller but needed to pre-calibrate the local coordinate system of the multi-agent systems [36]. Aryankia K et al. designed the distance-based adaptive neural network controller for communication delays and external nonlinear disturbances to achieve formation generation and tracking control [37]. Vu D V et al. proposed the distance-based formation controller using a leader–follower structure to achieve formation tracking control under the constant leader speed [38]. In the distance-based UAV formation control method, UAVs can realize formation control only by perceiving the distance between their neighbors and their own sensing device. This control strategy has important applicational value for UAV formation.
The actuator failures cannot be ignored in the design of PFC controllers, especially for UAV formation. In recent years, adaptive fault-tolerant control technology has rapidly developed. This control method addresses the problems of system uncertainty and parameter changes caused by faults during flight and achieves stability and tracking performance by adjusting the controller. In [39], the distributed fault-tolerant control approach was used to design an adaptive fault compensation controller by effectively estimating the fault information of the actuator. Another approach is to use neural networks to approximate the nonlinear terms [40]. The authors in [41] combined the adaptive backstepping control method with neural networks to approximate nonlinear terms, which effectively solved the problem in the fault-tolerant control of multiple UAVs. Therefore, it is important to consider the fault of actuators and to design adaptive fault-tolerant controllers when designing UAV formation controllers.
Motivated by the discussion above, the distance-based formation control problem for fixed-wing UAVs with input constraints, unknown external disturbances, and unmodeled dynamics is considered in this paper. Based on the distance-based formation control structure, longitudinal and lateral subsystem adaptive fault-tolerant controllers are designed, respectively. To address the problem of controller input saturation due to physical and structural characteristics, the adaptive sliding mode fault-tolerant controllers with an adaptive auxiliary controller are designed to achieve the fault-tolerant control of UAVs’ PFC under input saturation. The main contributions of this paper are stated as follows.
(1) Compared to [42], our controller is designed independently from a global reference coordinate and does not require the local frame of all vehicles to be aligned. Only the distance requirements are used with local sensors to ensure UAV formation maintenance.
(2) In contrast to [43] regarding the formation control of multi-UAVs with three-degree-of-freedom (3-DOF) outer-loop position models, the formation flight control scheme is developed on the nonlinear 6-DOF UAV model. Therefore, the developed control method is more practical.
(3) To solve the problem of controller input saturation limitations caused by physical and structural characteristics, an adaptive control method is proposed for UAV formation. The auxiliary controller is introduced to eliminate the nonlinear factor of the input limitation, and the adaptive sliding mode controller is designed to realize the path tracking control for UAV formation.
(4) In order to solve the influence of uncertain factors such as external disturbances and unmodeled dynamics, adaptive fault-tolerant controllers are designed for longitudinal subsystems and lateral subsystems, respectively, to realize the path tracking fault-tolerant control of UAV formation in three-dimensional space.
The remaining parts of this paper are organized as follows. The concepts of rigid graph theory, the nonlinear fixed-wing UAV model, and distance-based formation control objectives are described in Section 2. The distributed adaptive fault-tolerant distance-based formation controller and stability analysis of the closed-loop system are presented in Section 3. Numerical simulations are conducted in Section 4. Finally, conclusions are drawn in Section 5.
2. Materials and Methods
In this section, the concept of rigid graph theory is introduced for distance-based formation. Then, by establishing the dynamics of the fixed-wing UAV, the input saturation and fault model, the fault-tolerant formation control scheme is presented.
2.1. Rigid Graph Theory
An indirect graph with pair is defined as a set of vertices connected with a set of undirected edges
such that if the edge is in , then . The number of edges that amounts for the connection between the vertices is . The set of neighbors of vertex is defined as such that . A framework of is the pair , where is the stack vector containing the position of all quad rotors. The rigidity function associated with is denoted by , where denotes the Euclidian norm and represents the relative position vector of . The rigidity matrix of is defined as . It can be shown similar to [44] that rank . It follows that is infinitesimally rigid [36] in if the corresponding graph has at least edges. An isometry of is a bijective map:, satisfying . Two frameworks are said to be isomorphic in if they are related by isometry. The set of all frameworks that is isomorphic to is denoted by . Frameworks and are equivalent if and are congruent if . If the infinitesimally rigid frameworks and are equivalent but not congruent, they are called ambiguous. The collection of frameworks which are ambiguous to the infinitesimally rigid frameworks is denoted by .
Lemma 1
([45]). Given a vector , and let be the vector of ones, then.
Lemma 2
([46]). If the framework is minimally and infinitesimally rigid, the matrix is positive definite.
2.2. Model of the Fixed-Wing UAV
In this section, we consider a group of n UAVs in the formation, by denoting as the set of UAVs. The nonlinear model of the i-th fixed-wing UAV is expressed as in [45].
The force equations can be described as follows:
The attitude dynamic model is given as
The forces , , , , and the aerodynamic moments are given as
where . Then, the nonlinear model of UAV is divided into the longitudinal dynamics and the lateral–directional dynamics [46]. The nonlinear 6-DOF fixed-wing UAV model is investigated as illustrated in Figure 1.
Figure 1.
UAV model.
Assumption 1.
The terms and can be ignored since they are cross derivatives and usually have little effects on the fixed-wing UAV [46].
Assumption 2.
The inertial term is assumed to be negligible since is small on the fixed-wing UAV [46].
Assuming , , , and are small enough, the is much smaller than [47]. The external disturbance is considered. Then, according to Assumption 1, the longitudinal dynamics of the i-th UAV can be divided into the forward and vertical subsystems.
The forward subsystem is given by
The vertical subsystem is formulated as
where , , , , , , and can be expressed as
The definitions of , , and are quite small in the lateral–directional motion of the i-th UAV [47]. The external disturbance is considered. Then, according to Assumption 2, the lateral–directional dynamics can be divided into the side-distance and sideslip angle subsystems.
The side-distance subsystem can be described as follows:
The sideslip angle subsystem is given by
where , , , , , and are given as
Remark 1.
To reduce the cost caused by accurately measuring all aerodynamic parameters by the wind tunnel experiments, it is assumed that only the aerodynamic parameters involved in , , , and are known. The aerodynamic parameters in the functions , ,, , , and are assumed to be unknown.
2.3. Input Saturation Model
The input saturation problem of UAV refers to the fact that when it performs maneuvers, the actuators tend to perform actions that are required to be larger to maintain the stability of the flight control system, and this will lead to a saturation of the actuator rudder surface. The nonlinear factor of controlling the rudder surface saturation makes the control system unable to obtain the desired feedback, resulting in a UAV control system in an open-loop state, and the control input, if not effectively regulated, will lead to a longer regulation time and even lead to a loss of control [48]. Therefore, considering the physical constraints of the actuator is an important part to ensure safety and reliability of the system when designing a UAV flight control system.
The control input of the UAV is , the elevator rudder deflection angle is , the engine throttle opening and closing is , the aileron rudder deflection angle is , and the rudder deflection angle is . In this paper, the four control inputs are considered to have input saturation, and the model is
where is the maximum value of the control input, so that the actual control input can be described as
where denotes the restricted input and denotes the actual input command.
2.4. Fault Model
The actuator fault model is given by
where represents the actual control input signal, denotes the designed control input signal, and is the effectiveness matrix. is the bias fault vector.
Substituting (14) into (7d), (9c), and (10b) gives
where , , and .
Therefore, the subsequent FTC scheme will be constructed based on the transformed forward subsystem (6a,b), the vertical subsystem (7a–c) and (15a), the side-distance subsystem (9a), (8b), and (15b), and the sideslip angle subsystem (10a) and (15c).
2.5. Control Objective
In this section, the control objective is to design the fault-tolerant formation control scheme for multiple UAVs against external disturbances and unknown aerodynamic parameters, such that all UAVs can maintain the distance-based formation and track the pre-defined path. The control scheme consists of two parts: (1) A path-following controller of a leader UAV is first developed based on the dynamic surface control; (2) a velocity estimator of UAV-based distance-based formation is developed to estimate each UAV by adding the pre-defined time varying relative path to the estimated leader’s position signal. The control structure is shown in Figure 2.
Figure 2.
Fault-tolerant control structure for path following of UAV formation with input saturation.
3. Distributed Adaptive Fault-Tolerant Controller Design and Analysis
3.1. Path-Following Controller of Leader UAV
In this subsection, by using the adaptive dynamic surface technology, the path tracking controller of the leader UAV is designed to achieve the tracking control. The expected path of the leader is defined as , and the virtual arc length is parameterized , where is the virtual total arc length. The goal of the path tracking control is to design a tracking controller to converge the UAV position to the desired path . It is worth noting that the expected path is independent of time through the description of the path by parameters, and then the tracking problem is transformed into a static path tracking problem emphasizing geometric position.
The tracking error is defined as follows:
where represents the position tracking error and represents the path parameter velocity tracking error.
Taking the derivative of and , we have
We choose the following Lyapunov function
where are the subfunction gain.
From (18) and (19), the time derivative of (20) is
The feedback control law of the leader is designed as
Next, the path parameter is proposed as follows:
3.2. Distance-Based Formation Controller Design of UAVs
3.2.1. Tracking Speed Control Law for UAVs
Considering the multi-UAV system in three-dimensional space, the kinematics of i-th UAV can be described as
where denotes the position in the inertial frame and is the control input.
The relative position between neighboring UAVs can be designed as
Thus, for each edge of the rigid graph, the distance error can be defined by
where is the actual distance between agents and .
Assuming the minimum and infinitesimal rigidity under the initial conditions of the diagram of the formation, the control objective is to design a distributed robust control system and to satisfy
where , , and , .
If we define the square distance error as , then we can obtain
Until now, the error can be rewritten as
where , , and .
Then, we have
From (23) and (24), the time derivative of is
From (31) and (27), the derivative of is given by
From the rigid graph matrix, Equation (34) can be rewritten as
where , , and .
The squared distance error is designed as
Then, the error system can be rewritten as
Taking the time derivative of , we have
where
Then, can be written as the following form
where , , and .
We design the following controller
where and R is the rigid diagram matrix.
According to the tracking control speed in Section 3.1, which is only available to the formation leader, we define the center position of the formation as follows:
Thus, we define the control law , so that the path tracking control of the UAV formation in three-dimensional space can be realized.
The tracking speed control law is designed as
where .
For each edge of the graph, we choose a Lyapunov function candidate:
Considering the entire graph system, from (44), the Lyapunov function is defined as
Taking the time derivative of gives
3.2.2. PPC Design for Longitudinal Dynamics
In this section, it will be shown that the longitudinal fault-tolerant tracking controller is designed based on the backstepping method. The vertical controller system includes a forward motion subsystem and a vertical motion subsystem. In order to achieve the objective of this section, the neural network controller is used to compensate for external uncertain perturbations and the adaptive sliding mode controller is used to achieve fault-tolerant control with actuator failures. An auxiliary controller considering input constraints is used to compensate for the nonlinear characteristics of control input saturation.
(a) Forward subsystem
According to the designed in Section 3.2.1, the desired flight speed can be obtained from (6a).
To avoid the differential explosion phenomenon caused by derivatives, the controller is designed using the dynamic surface method and a first-order filter is introduced as
where is a virtual control signal and is time constant.
We define the first-order filter error as , and the time derivative of is
where .
We define the speed tracking error as
The time derivative of can be then calculated as
Consider the following Lyapunov function:
The time derivative of (52) is
We propose the following thrust control input:
where if and is an unknown nonlinear vector, then the radial basis function neural network (RBFNN) is used to estimate , which is given by
where and are the input and optimal weighting vector of RBFNN, is the estimation error, which satisfies , and is a constant. The control law is expressed as
where represents the estimation of .
We design the adaptive law as
where and are constants.
The approximation error of RBFNN is .
In order to solve the input saturation problem of UAV engine thrusts in the actual flight control process, the auxiliary system is designed as
where and . And represents the state variable for the auxiliary system. , , and are constants to be designed. and represent the actual control input and the desired control input, respectively. The auxiliary system is adjusted when input saturation occurs in the system, such as when the input saturation is eliminated, , , and decay exponentially to until ; otherwise, when saturation occurs again, , the auxiliary system will be adjusted again.
Considering the errors of RBFNN and the auxiliary system, we choose the following Lyapunov function
Differentiating (59) yields
(b) Vertical subsystem
Based on the in Section 3.2.1, the desired trajectory angle is obtained from (6a).
We define , and the time derivative of is
We define the Lyapunov function as
The time derivative of (63) is
We design the pitch angle control input as
where . Because is an unknown nonlinear vector, the RBFNN is used to estimate .
where and are the input and optimal weighting vector of RBFNN and is the estimation error, which satisfies . We define the pitch angle control input as
where is the estimation of . We design the adaptive law as
where and are constants.
The approximation error of RBFNN is . The first-order filter is introduced to compute the time derivative of the control signal, which is designed as
where is the virtual control signal and is a time constant.
We define the first-order filter error as , and the time derivative of is
where .
We define the Lyapunov function as
The time derivative of (71) is
By defining the pitch angle tracking error , one has .
The pitch angle rate control signal is designed as
where is a constant. The first-order filter is introduced as
where is the virtual control signal and is the time constant.
Define the first-order filter error as , and the time derivative of is
where .
We choose the Lyapunov function
The time derivative of (76) is
If we define the pitch angle rate tracking error as , then one has
Then, the elevator control input signal is designed as
where .
The RBFNN is used to estimate , which is given by
where and are the input and optimal weighting vector of RBFNN and is the estimation error, which satisfies .
Based on (80), the adaptive law is designed as
where is estimation of and is the approximation error of RBFNN.
By introducing the adaptive sliding mode function to realize the fault-tolerance control for the unknown faults of an elevator actuator, the sliding mode function is designed as
where is a constant and the time derivative of (82) is
Taking and , we choose the following Lyapunov function
where . The time derivative of (84) is
We design the virtual control signal as
where and .
Substituting (85) into (84) gives
We design control law and adaptive law as
where .
Considering the elevator control input saturation of the UAV during the actual flight control process, the following auxiliary system is designed as
where and . is the state variable of the auxiliary system, , , and are constants to be designed, and and are the actual control input and the desired control input.
Considering the influence of the pitch angle rate tracking errors and auxiliary control systems, we choose the following Lyapunov function
The time derivative of (91) is
3.2.3. The Transverse Lateral Controller Design of the Drone under Restricted Conditions
This subsection will design the lateral and lateral fault-tolerant controller of the UAV according to Section 3.2.1 and Section 3.2.2 and will design the distributed fault-tolerant controller for the lateral control subsystem and the lateral slip angle control subsystem with an aileron actuator failure and a rudder actuator failure, respectively, by the dynamic surface neural network control technique.
(a) Lateral subsystem
According to the designed in Section 3.2.1, the desired yaw angle can be obtained as
To avoid the differential explosion phenomenon caused by derivatives, the first-order filter is designed as
where is the virtual control signal and is a time constant.
By defining the filtering error as , the time derivative of is
where .
We define the first-order filter error as , and the virtual control signal is designed as
We choose the following Lyapunov function
The time derivative of (97) is
The relationship between the angular velocity and the Euler angular velocity can be expressed as
In the lateral motion of UAV, we have
According to (99) and (100), the expected roll angle can be expected as
We define the roll angle tracking error as , and the time derivative of is
The roll angle rate is designed as
where is the parameter to be designed.
The first-order filter is constructed as
where is a virtual control signal and is time constant.
We define the filtering error as , and the time derivative of is
where .
We choose the following Lyapunov function
The time derivative of (106) is
If we define the roll angle rate tracking error as
then one has
We design the aileron control input signals as
where . The RBFNN is used to estimate , which is given by
where and are the input and optimal weighting vector of RBFNN and is an estimation error, which satisfies . The neural network output is , and is the estimation of . The adaptive law is designed as
where are constants. The error of RBFNN is .
To realize the fault-tolerance control of the aileron actuator, we introduce the following adaptive sliding mode function:
where is a constant. By differentiating (112), one can obtain
By defining and , we choose the following Lyapunov function
where , and one has
We design the virtual control amount as
where and .
Then, one has
We design the control law and the adaptive law as
where .
In order to solve the control input saturation problem of the aileron actuator during the actual flight control of UAVs, the following auxiliary system is designed as
where , , is the state variable for the auxiliary system, , , and are constants to be designed, and and are the actual control input and the desired control input.
Considering the rolling angle rate tracking error and the influence of the auxiliary control system, we choose the following Lyapunov function
Taking the time derivatives of (122) yields
(b) Sliding angle subsystem
If we define the slip angle tracking error as , then one has
We design the yaw angle rate control input signal as
The RBFNN is used to estimate , which is given by
where and are the input and optimal weight vector of RBFNN and is the estimation error, which satisfies . We define the yaw angle rate control input as
The adaptive law is given by
where and are constants.
The neural network approximation error is . The first-order filter is introduced as
where is a virtual control signal and is the time constant.
If we define the filtering error as , then one has
where .
We choose the following Lyapunov function
Then, taking the time derivative of (131) yields
If we define the yaw angle rate tracking error as , then one has
We design the rudder control input signal as
where . The RBFNN is used to estimate , which is given by
where and are the input and optimal weighting vector of RBFNN and is the estimation error and satisfies . The neural network output is , and the adaptive law is designed as
where and are constants. The neural network approximation error is .
In order to solve the fault-tolerant control problem of the unknown faults of a rudder actuator, the adaptive sliding mode function is introduced as
where .
Taking the time derivative of (136) yields
We choose the following Lyapunov function
where and . Then, we have
We design the virtual control signal as
where and .
Substituting (140) into (141), we obtain
We design the control law and adaptive law as
where .
Considering the control input saturation of the rudder actuator during the actual flight process of UAVs, the following auxiliary system is designed as
where and . is the state variable for the auxiliary system, , , and are constants to be designed. and are the actual control input and the desired control input.
Considering the rolling angle rate tracking error and auxiliary control system, we choose the following Lyapunov function
Taking the time derivative of (146) yields
3.3. Stability Analysis
Theorem 1.
Considering a group of UAVs, the distributed adaptive path-following control of a multi-UAV system can be achieved using the thrust controller (56), the elevator control law (79), the aileron control law (110), the rudder control law (134), the RBF parameter adaptive law (57), (68), (81), (112), (128), and (136), filters (48), (59), (94), (104), and (129), path-tracking controllers (22), path parameter feedback control laws (23), formation controllers (43), adaptive sliding mode controllers (88), (89), (119), (120), (143), and (144), and the closed-loop control system consisting of the auxiliary control system (90), (121), and (145). Therefore, all signals of the closed-loop system are ultimately semi-globally and uniformly bounded, and the tracking errors can converge to an arbitrarily small residual set.
Proof.
To demonstrate the stability of controllers, we first define the overall Lyapunov function for a multi-UAV system.
By utilizing Young’s inequality and taking the time derivative of L, one has
where and is the constant. and are chosen as
The errors , and are semi-globally consistently bounded within the following tight sets.
This completes the proof of Theorem 1. □
4. Simulation Results
In this section, a group of two follower UAVs and one leader UAV is considered. To demonstrate the feasibility of the proposed controller for a multi-UAV system, the experimental simulation validation is carried out based on the Links-RT UAV Platform (supported by Beijing Links Company, Ltd., from Beijing, China.). The experiment setup and relationship between functional units are depicted in Figure 3 and Figure 4. The proposed controller is first implemented in MATLAB. Then, the code generation by Links-Auto Coder is used to convert the MATLAB language into C code, which is downloaded by Pixhawk. Pixhawk is responsible for executing the proposed control algorithm with a sampling time of 2 ms and generating pulse width modulation (PWM) signals, which are sent to the real-time simulator, such that the velocity and attitude motion are calculated and transmitted to Pixhawk and the monitoring computer, while presenting the flight scene in X-PLANE11 and plotting the velocity and attitude tracking curves on MATLAB.
Figure 3.
Experiment prototype of the Links-RT UAV platform.
Figure 4.
Relationship between functional units.
The desired path of the leader is defined by
The initial position of the leader UAV is , and the initial positions of the other two UAVs are and , respectively. The initial velocity of the follower UAVs is , the initial values are taken as and , respectively. The desired distance between the follower UAVs is chosen as . The rigidity matrix of the formation is chosen as
The external disturbance of the formation is , , , , and . The failure for the UAV#1 at t = 30 s is defined as
In the experiment, the maximum value of the actuator control input is . The parameters of the controllers are shown in Table 1. The experimental simulation results are shown in Figure 5, Figure 6, Figure 7, Figure 8, Figure 9, Figure 10 and Figure 11.
Table 1.
Parameters of controllers.
Figure 5.
UAV formation path-tracking effect under input constraints. The red squares indicate UAV#i. The blue triangles indicate the formation configuration.
Figure 6.
Formation distance error variation under input constraint.
Figure 7.
Formation UAV flight status under input constraints. (a) Vi response. (b) βi response. (c) αi response.
Figure 8.
Angular velocity of formation UAV under input constraints. (a) pi response. (b) qi response. (c) ri response.
Figure 9.
Formation UAV attitude angle under input constraints. (a) response. (b) θi response. (c) response.

Figure 10.
Formation UAV input control volume under input constraints. (a) response. (b) response. (c) response. (d) response.
Figure 11.
Approximation error of RBFNN for uncertain terms under input constraint.
Remark 2.
When selecting the control parameters, it is first classified to determine which type the parameters belong to, and then they are selected according to the characteristics of each type of parameter and design experience. Through multiple simulation verifications, the optimal parameter value is finally determined according to the effect of the control response.
Figure 5 gives the UAV formation path tracking effect under input constraints. The blue line is the flight path of the leader which tracks the desired path defined by , , and . Figure 5 shows the tracking control effect considering the external disturbances and actuator failure under the input-constrained condition. It is observed that the tracking trajectory is relatively smooth considering the input constraint. The distance error of the formation is shown in Figure 6. It can be observed that the distance error of each UAV can converge to a finite value with the desired convergence rate at t = 10 s. It can be seen that the convergence rate is flat due to the consideration of the input constraint condition. In other words, within a short time after takeoff, the distance between the three UAVs reaches the desired formation distance and finally achieves the desired stable configuration. During this period, despite the influence of external interferences and input saturation, and the specific actuator failure of No. 1 UAV at t = 30 s, due to the role of the proposed distributed adaptive path-following controller, all these do not affect the effective formation of stable formations.
Figure 7, Figure 8 and Figure 9 show the flight states of UAV#1-UAV#3, and the values of each state of the UAV tend to stabilize after the initial formation generation process of the flight. From Figure 7c, it can be seen that the angle of attack on UAV#3 oscillated considerably at t = 3 s but returned to a stable state after 2 s. The relationship between the three angles is θ = γ + α. According to Equation (7b,c), it can be concluded that this is the result of an external disturbance . From Figure 8a,b and Figure 9a,b, it can be seen that the roll rate and pitch rate and the roll angle and pitch angle change dramatically within 5 s and become stable after 5 s. According to Equations (7c,d) and (9b,c), this is caused by unmodeled dynamics and external disturbances . When the three UAVs are subjected to these effects, the ailerons and elevators need to produce certain roll moments and pitch moments to counteract their effects, respectively. After the action of the roll moment and pitch moments, the roll rate and pitch rate change, and then the roll angle and pitch angle change correspondingly, respectively. This is also reflected in Figure 10a,b. It can be seen that there is chattering in the responses of the roll rate and pitch rate and the roll angle and pitch angle due to the sliding mode controller. In addition, it can be seen that the actuator of UAV#1 is faulty at t = 30 s, and the control input is adjusted by the adaptive sliding mode controller. Despite these uncertain effects, in terms of the control performance, the states of the UAVs can change smoothly under the distributed adaptive path-following controller.
It can be observed from Figure 10 that the control inputs of each UAV can be kept within the maximum control input after considering the input constraint. At t = 30 s, there is a significant change in the control input of UAV#1 when it fails, and the control inputs of the other UAVs are minimally affected. Since this paper implements the fault-tolerant control of UAV actuator failures through an adaptive sliding mode controller, the control input has a chattering phenomenon. And in Figure 10, it can be seen that there is chattering in the control input due to the sliding mode controller, which is most obvious especially when the actuator fails, as a result of the introduction of the adaptive sliding-mode fault-tolerant controller, which needs to be studied in depth subsequently.
Figure 11 shows the approximation error of the RBFNN for the uncertainty terms, and it is observed that the approximation errors of the UAVs are bounded. At t = 30 s, the error of UAV#1 becomes significantly small under the RBFNN, which dealing with the uncertainties generated by the actuator failure. Generally, by introducing the adaptive sliding mode fault-tolerant controller, the approximation error of the RBFNN is obviously improved after the fault occurs. It can be seen that the proposed neural network controller can effectively approximate and compensate the model uncertainty terms , , , , , and and the external disturbances , , , and .
Remark 3.
Compared to the numerous existing formation control methods for the outer-loop position model expressed by the double-integrator form, this paper focuses on developing the distributed fault-tolerant formation flight control scheme for multiple 6-DOF fixed-wing UAVs against unknown aerodynamic parameters, actuator faults, and input saturations. To solve this controller design challenge, the distributed adaptive path-following controller for distance-based formation is first proposed. The path-following control strategy which combined the adaptive dynamic surface and neural network control technology was employed to approximate the uncertain disturbances of the environment and unmodeled dynamics. The auxiliary controller solved the stability of the formation control system under input limitations. In addition, by designing an adaptive sliding mode fault-tolerant controller, the stability of the formation flight was ensured in the case of actuator failures of the UAVs. The experimental simulation results have demonstrated the feasibility of the proposed controller for a multi-UAV system.
5. Conclusions and Future Works
In this paper, the distributed adaptive path-following control for distance-based formation was proposed for multiple fixed-wing UAVs under input saturations and actuator faults in a three-dimensional environment. By dividing the fixed-wing UAV model into the longitudinal dynamics containing the forward and vertical subsystems and the lateral–directional dynamics containing the lateral and sideslip angle subsystems, two adaptive fault-tolerant controllers are proposed to regulate the longitudinal and lateral–directional motions of multiple fixed-wing UAVs based on the distance-based formation control structure and dynamic surface control. The path-following control strategy which combined the adaptive dynamic surface and neural network control technology was proposed, where the uncertain disturbances of the environment and unmodeled dynamics can be approximated. The auxiliary controller solved the stability of the formation control system under input limitations. In addition, by designing an adaptive sliding mode fault-tolerant controller, the stability of the formation flight was ensured in the case of actuator failures of the UAVs. It was shown by the Lyapunov method that all signals are ultimately semi-globally and uniformly bounded and the tracking performance can be achieved even when the fixed-wing UAVs are subjected to the input saturations and actuator faults. Finally, the experimental simulation validation was provided to demonstrate the feasibility and superiority of the proposed control scheme.
In the early stage of formation and after the actuator failure of a UAV, the UAV will often have a large flight action, which may lead to the collision of the UAV in the formation. Designing a collision avoidance controller is the key technology to realize large-scale formation flights, which is one of the next research directions. In addition, the experimental simulation of this paper only considers the formation flight of three UAVs, and more UAV formation flight simulations is also a direction of future work. Furthermore, the proposed controller has many control parameters, so how to simplify the control parameters is one of the key problems to be solved in the future.
Author Contributions
Conceptualization, S.L. (Shuguang Liu); methodology, J.W. and H.W.; software, H.W.; validation, J.W. and S.L. (Shanshan Li); formal analysis, J.W. and S.L. (Shanshan Li); investigation, S.L. (Shuguang Liu); resources, S.L. (Shuguang Liu); writing—original draft preparation, J.W., H.W., S.L. (Shanshan Li), and S.L. (Shuguang Liu); writing—review and editing, J.W. and S.L. (Shuguang Liu). All authors have read and agreed to the published version of the manuscript.
Funding
This research was funded by the National Natural Science Foundation of China (No. 72271243, 61976176) and the key laboratory of National Defense Technology Foundation for Equipment Pre-Research of China (No. 6142219200301).
Institutional Review Board Statement
Not applicable.
Informed Consent Statement
Not applicable.
Data Availability Statement
Data are available on request due to restrictions, e.g., privacy or ethical. The data presented in this study are available by contacting the corresponding author. The data are not publicly available due to commercial use.
Conflicts of Interest
The authors declare no conflict of interest.
Nomenclature
| Subscript i | the ith UAV |
| , g | the positions of the UAV in the inertia frame |
| velocity, sideslip angle, angle of attack | |
| velocity, sideslip angle, angle of attack | |
| roll, pitch, yaw angles | |
| thrust, drag, side forces | |
| roll, pitch, yaw rates | |
| roll, pitch, and yaw moments | |
| aileron, elevator, rudder deflections, instantaneous thrust throttle setting | |
| maximum thrust force, aerodynamic coefficient | |
| external disturbances |
References
- Ouyang, Q.; Wu, Z.; Cong, Y.; Wang, Z. Formation control of unmanned aerial vehicle swarms: A comprehensive review. Asian J. Control 2023, 25, 570–593. [Google Scholar] [CrossRef]
- Chen, L.; Xiao, J.; Lin, R.C.H.; Feroskhan, M. Angle-Constrained Formation Maneuvering of Unmanned Aerial Vehicles. IEEE Trans. Control Syst. Technol. 2023, 31, 1733–1746. [Google Scholar] [CrossRef]
- Shao, X.L.; Liu, H.C.; Zhang, W.D.; Zhao, J.; Zhang, Q.Z. Path driven formation-containment control of multiple UAVs: A path-following framework. Aerosp. Sci. Technol. 2023, 135, 108168. [Google Scholar] [CrossRef]
- Nian, X.H.; Zhou, W.X.; Li, S.L.; Wu, H.Y. 2-D path following for fixed wing UAV using global fast terminal sliding mode control. ISA Trans. 2023, 136, 162–172. [Google Scholar] [CrossRef] [PubMed]
- Chung, S.-J.; Paranjape, A.A.; Dames, P.; Shen, S.; Kumar, V. A Survey on Aerial Swarm Robotics. IEEE Trans. Robot. 2018, 34, 837–855. [Google Scholar] [CrossRef]
- Cabecinhas, D.; Cunha, R.; Silvestre, C. Rotorcraft path following control for extended flight envelope coverage. In Proceedings of the 48th IEEE Conference on Decision and Control, CDC 2009, Combined with the 28th Chinese Control Conference, Shanghai, China, 15–18 December 2009; pp. 16–18. [Google Scholar]
- Cabecinhas, D.; Cunha, R.; Silvestre, C. A Globally Stabilizing Path Following Controller for Rotorcraft with Wind Disturbance Rejection. IEEE Trans. Control Syst. Technol. 2015, 23, 708–714. [Google Scholar] [CrossRef]
- Klausen, K.; Fossen, T.I.; Johansen, T.A.; Aguiar, A.P. Cooperative path-following for multirotor UAVs with a suspended payload. In Proceedings of the IEEE Conference on Control Applications (CCA), Sydney, Australia, 21–23 September 2015; pp. 1354–1360. [Google Scholar]
- Akkinapalli, V.S.; Niermeyer, P.; Lohmann, B.; Holzapfel, F. Adaptive nonlinear design plant uncertainty cancellation for a multirotor. In Proceedings of the International Conference on Unmanned Aircraft Systems (ICUAS), Arlington, VA, USA, 7–10 June 2016; pp. 1102–1110. [Google Scholar]
- Rucco, A.; Aguiar, A.P.; Hauser, J. Trajectory optimization for constrained UAVs: A Virtual Target Vehicle approach. In Proceedings of the International Conference on Unmanned Aircraft Systems (ICUAS), Denver, CO, USA, 9–12 June 2015; pp. 236–245. [Google Scholar]
- Rucco, A.; Aguiar, A.P.; Pereira, F.L.; de Sousa, J.B. A Predictive Path-Following Approach for Fixed-Wing Unmanned Aerial Vehicles in Presence of Wind Disturbances. In Proceedings of the Second Iberian Robotics Conference, Lisbon, Portugal, 19–21 November 2015. [Google Scholar]
- Desai, J.P.; Ostrowski, J.P.; Kumar, V. Controlling formations of multiple mobile robots. In Proceedings of the IEEE International Conference on Robotics and Automation (Cat. No.98CH36146), Leuven, Belgium, 20–20 May 1998; pp. 2864–2869. [Google Scholar]
- Byrnes, C.I.; Isidori, A. Asymptotic stabilization of minimum phase nonlinear systems. IEEE Trans. Autom. Control 1991, 36, 1122–1137. [Google Scholar] [CrossRef]
- Edwards, C.; Spurgeon, S. Sliding Mode Control: Theory And Applications; CRC Press: Boca Raton, FL, USA, 1998. [Google Scholar]
- Shah, M.Z.; Samar, R.; Bhatti, A.I. Lateral track control of UAVs using the sliding mode approach: From design to flight testing. Trans. Inst. Meas. Control 2014, 37, 457–474. [Google Scholar] [CrossRef]
- Thanh, H.L.N.N.; Vu, M.T.; Mung, N.X.; Nguyen, N.P.; Phuong, N.T. Perturbation observer-based robust control using a multiple sliding surfaces for nonlinear systems with influences of matched and unmatched uncertainties. Mathematics 2020, 8, 1371. [Google Scholar] [CrossRef]
- Alattas, K.A.; Mobayen, S.; Din, S.U.; Asad, J.H.; Fekih, A.; Assawinchaichote, W.; Vu, M.T. Design of a non-singular adaptive integral-type finite time tracking control for nonlinear systems with external disturbances. IEEE Access 2021, 9, 102091–102103. [Google Scholar] [CrossRef]
- Mofid, O.; Amirkhani, S.; Din, S.U.; Mobayen, S.; Vu, M.T.; Assawinchaichote, W. Finite-time convergence of perturbed nonlinear systems using adaptive barrier-function nonsingular sliding mode control with experimental validation. J. Vib. Control 2023, 29, 3326–3339. [Google Scholar] [CrossRef]
- Rojsiraphisal, T.; Mobayen, S.; Asad, J.H.; Vu, M.T.; Chang, A.; Puangmalai, J. Fast terminal sliding control of underactuated robotic systems based on disturbance observer with experimental validation. Mathematics 2021, 9, 1935. [Google Scholar] [CrossRef]
- Alattas, K.A.; Vu, M.T.; Mofid, O.; El-Sousy, F.F.M.; Alanazi, A.K.; Awrejcewicz, J.; Mobayen, S. Adaptive nonsingular terminal sliding mode control for performance improvement of perturbed nonlinear systems. Mathematics 2022, 10, 1064. [Google Scholar] [CrossRef]
- Mobayen, S.; Bayat, F.; Din, S.U.; Vu, M.T. Barrier function-based adaptive nonsingular terminal sliding mode control technique for a class of disturbed nonlinear systems. ISA Trans. 2023, 134, 481–496. [Google Scholar] [CrossRef]
- Ghaffari, V.; Mobayen, S.; Din, S.U.; Rojsiraphisal, T.; Vu, M.T. Robust tracking composite nonlinear feedback controller design for time-delay uncertain systems in the presence of input saturation. ISA Trans. 2022, 129, 88–99. [Google Scholar] [CrossRef]
- Roza, A.; Maggiore, M. Path following controller for a quadrotor helicopter. In Proceedings of the American Control Conference (ACC), Montreal, QC, Canada, 27–29 June 2012; pp. 4655–4660. [Google Scholar]
- Raffo, G.V.; Ortega, M.G.; Rubio, F.R. Backstepping/nonlinear H∞ control for path tracking of a quadrotor unmanned aerial vehicle. In Proceedings of the American Control Conference, Seattle, WA, USA, 11–13 June 2008; pp. 3356–3361. [Google Scholar]
- Kaminer, I.; Yakimenko, O.; Pascoal, A.; Ghabcheloo, R. Path Generation, Path Following and Coordinated Control for TimeCritical Missions of Multiple UAVs. In Proceedings of the 2006 American Control Conference, Minneapolis, MN, USA, 14–16 June 2006; pp. 4906–4913. [Google Scholar]
- Xargay, E.; Kaminer, I.; Pascoal, A.; Hovakimyan, N.; Dobrokhodov, V.; Cichella, V.; Aguiar, A.P.; Ghabcheloo, R. Time-Critical Cooperative Path Following of Multiple Unmanned Aerial Vehicles over Time-Varying Networks. J. Guid. Control Dyn. 2013, 36, 499–516. [Google Scholar] [CrossRef]
- Chen, H.; Cong, Y.; Wang, X.; Xu, X.; Shen, L. Coordinated Path Following Control of Fixed-wing Unmanned Aerial Vehicles. IEEE Trans. Cybern. 2019, 52, 2540–2554. [Google Scholar]
- Ren, W.; Atkins, E. Distributed multi-vehicle coordinated control via local information exchange. Int. J. Robust Nonlinear Control 2007, 17, 1002–1033. [Google Scholar] [CrossRef]
- Meng, Z.; Anderson, B.D.; Hirche, S. Formation control with mismatched compasses. Automatica 2016, 69, 232–241. [Google Scholar] [CrossRef]
- Ramazani, S.; Selmic, R.; de Queiroz, M. Rigidity-based multiagent layered formation control. IEEE Trans. Cybern. 2017, 47, 1902–1913. [Google Scholar] [CrossRef]
- Cai, X.; de Queiroz, M. Rigidity-based stabilization of multi-agent formations. J. Dyn. Syst. Meas. Control 2014, 136, 014502. [Google Scholar] [CrossRef]
- Dorfler, F.; Francis, B. Geometric analysis of the formation problem for autonomous robots. IEEE Trans. Autom. Control 2010, 5, 2379–2384. [Google Scholar] [CrossRef]
- Krick, L.; Broucke, M.E.; Francis, B.A. Stabilisation of infinitesimally rigid formations of multi-robot networks. Int. J. Control 2009, 82, 423–439. [Google Scholar] [CrossRef]
- Oh, K.K.; Ahn, H.-S. Formation control of mobile agents based on inter-agent distance dynamics. Automatica 2011, 47, 2306–2312. [Google Scholar] [CrossRef]
- Babazadeh, R.; Selmic, R. Distance-based multi-agent formation control with energy constraints using SDRE. IEEE Trans. Aerosp. Electron. Syst. 2019, 56, 41–56. [Google Scholar] [CrossRef]
- Cai, X.; Queiroz, M. Formation maneuvering and target interception for multi-agent systems via rigid graphs. Asian J. Control 2015, 17, 1174–1186. [Google Scholar] [CrossRef]
- Aryankia, K.; Selmic, R.R. Neuro-Adaptive Formation Control and Target Tracking for Nonlinear Multi-Agent Systems with Time-Delay. IEEE Control Syst. Lett. 2021, 5, 791–796. [Google Scholar] [CrossRef]
- Vu, D.V.; Trinh, M.H.; Ahn, H.S. Distance--Based Formation Tracking with Unknown Bounded Reference Velocities. In Proceedings of the 20th International Conference on Control, Automation and Systems (ICCAS), Busan, Republic of Korea, 13–16 October 2020; pp. 524–529. [Google Scholar]
- Yu, Z.; Qu, Y.; Zhang, Y. Distributed Fault-Tolerant Cooperative Control for Multi-UAVs Under Actuator Fault and Input Saturation. IEEE Trans. Control Syst. Technol. 2018, 27, 2417–2429. [Google Scholar] [CrossRef]
- Chang, S.J.; Lee, J.Y.; Park, J.B.; Choi, Y.H. An online fault tolerant actor-critic neuro-control for a class of nonlinear systems using neural network HJB approach. Int. J. Control Autom. Syst. 2015, 13, 311–318. [Google Scholar] [CrossRef]
- Yu, Z.; Liu, Z.; Zhang, Y.; Qu, Y.; Su, C.Y. Distributed Finite-Time Fault-Tolerant Containment Control for Multiple Unmanned Aerial Vehicles. IEEE Trans. Neural Netw. Learn. Syst. 2019, 99, 2077–2091. [Google Scholar] [CrossRef]
- Hou, Z.; Fantoni, I. Leader-follower formation saturatedcontrol for multiple quadrotors with switching topology. In Proceedings of the Workshop on Research, Education and Development of Unmanned Aerial Systems (RED-UAS), Cancun, Mexico, 23–25 November 2015; pp. 8–14. [Google Scholar]
- Xiang, X.; Liu, C.; Su, H.; Zhang, Q. On decentralized adaptive full-order slidingmode control of multiple UAVs. ISA Trans. 2017, 71, 196–205. [Google Scholar] [CrossRef] [PubMed]
- Asimow, L.; Roth, B. The rigidity of graphs, II. J. Math. Anal. Appl. 1979, 68, 171–190. [Google Scholar] [CrossRef]
- Dogan, A.; Venkataramanan, S. Nonlinear Control for Reconfiguration of Unmanned-Aerial-Vehicle Formation. J. Guid. Control Dyn. 2005, 28, 667–678. [Google Scholar] [CrossRef][Green Version]
- Yu, Z.; Zhang, Y.; Jiang, B.; Yu, X.; Fu, J.; Jin, Y.; Chai, T. Distributed adaptive fault-tolerant close formation flight control of multiple trailing fixed-wing UAVs. ISA Trans. 2020, 106, 181–199. [Google Scholar] [CrossRef] [PubMed]
- Yu, Z.; Qu, Y.; Zhang, Y. Safe Control of Trailing UAV in Close Formation Flight against Actuator Fault and Wake Vortex Effect. Aerosp. EnceTechnol. 2018, 77, 189–205. [Google Scholar] [CrossRef]
- Payne, A.N. Adaptive one-step-ahead control subject to an input-amplitude constraint. Int. J. Control 1986, 43, 1257–1269. [Google Scholar] [CrossRef]
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. |
© 2023 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).