1. Introduction
The cooperative control of unmanned aerial vehicles (UAVs) has drawn significant research interests in both academia and industry [
1,
2]. The corresponding techniques in object detection [
3,
4], visual target tracking [
5,
6,
7], optimal path planning [
8,
9,
10], and coordinated control [
11,
12] are investigated, expecting to solve complex tasks in harsh environments. To ensure better convergence speed and strong robustness against disturbances, the finite-time control theory is proposed in the replacement of asymptotical stable control laws and implemented in various scopes of control applications. The quadrotor UAV is a mobile robot with vertical takeoff and landing properties and is typically used in three-dimensional multi-agent coordinative control verification [
12]. Equipped with complex decoupled subsystems of attitude and position, respectively, cascaded control loops are employed in quadrotors, requiring the investigation of nonlinear control laws in both attitude and position system dynamics. In the control framework of multiple quadrotor UAVs, the negotiation mechanism between neighboring UAVs is challenging, currently introducing significant potential for promotion. Since there exist obstacles with unknown shapes and diverse levels of threat in practical UAV applications, obstacle avoidance techniques are required to guarantee collision-free formation control performance. A variety of obstacle avoidance methods are developed; however, for a cluster of UAVs, adoptable collision avoidance mechanisms have seen a lack of investigation. Since there exists much inspiration from the basic interactive principles of biological swarms, autonomous formation control approaches or intelligent cooperating rules can be potentially synthesized. In this section, the existing literature is demonstrated in three aspects below: collision avoidance methodologies, finite-time control and application, and bio-inspired mechanisms in UAV coordinated control issues.
There exist comprehensive studies that emphasize obstacle avoidance, mainly in scenarios of multi-agent consensus and unmanned robotic swarms. These proposed approaches can mainly be divided into the following categories: obstacle avoidance approaches based on the potential field (PF) gradient [
13,
14,
15,
16], path planning regulator [
17,
18,
19], model predictive control [
20,
21,
22], and vector field guidance [
23,
24]. In [
25], the artificial potential field (APF) is employed on a fast terminal sliding mode surface, and both collision safety and obstacle avoidance in the formation control process are guaranteed. In [
26], Lyapunov-like barrier function series are designed to be combined into a distributed control protocol to maintain a conflict-free formation safety control for quadrotor UAVs. In [
27], a split–merge mechanism according to pigeons’ flocking behavior is embedded into the artificial potential field, and thus a steering controller to avoid obstacles is designed for multiple UAVs and validated through outdoor experiments. Apart from achieving obstacle-free control by combining the PF gradient with formation control laws, the PF is often integrated with path planning algorithms. In [
28], an adaptive APF with global search adjustment is proposed and embedded with Rapidly Exploring Random Tree Star (RRT*) for solving the path planning and task assignment issues of multiple UAVs. In [
29], both a novel repulsive coefficient and dynamic step-size-adjusting mechanism are introduced to build an improved APF, which is merged with RRT* and is proved to have optimal sampling direction and spatial distribution in the determination of the search path. Furthermore, a smooth shifting function and two collision-free functions are combined to construct a Lyapunov-based model predictive controller and applied to a UAV swarm in [
30] in a spatial space. Then, in [
31], a vector field is applied using the heading guidance law to attain collision-free formation among unmanned surface vessels.
The commonly used consensus control laws in our previous work only ensure that the error dynamic systems are asymptotically stable [
32,
33]. However, recent studies consider the newly designed Lyapunov functions to satisfy certain properties, resulting in system states converging into an ultimately bounded region within an upper time bound that corresponds to the initial system state, namely finite-time (FT) convergence. In [
34], a desired formation can be maintained through the decentralized FT observer and control law. In [
35], a distributed neural-network-based nonsingular fast terminal sliding mode controller is proposed to guarantee FT stability for multiple unmanned surface vehicles. In [
36], an event-triggered FT formation control protocol is established under a disturbance estimated by extended state observers.
Animals in the wild such as hawks, wolves, lions, and pigeons often spontaneously form groups to achieve coordination in hunting or evasion behavior. Some of those inspiring animal behaviors are similar to robotic swarms in several aspects, especially in agent translational kinematics as well as alignment and repulsive interactions among neighboring individuals [
37]. In [
38], the hierarchical social structure and robust interaction patterns of grey wolves are taken into consideration. Then, a bio-inspired adaptive formation consensus protocol is synthesized. Motivated by the chasing and anti-attack behavior in groups of coyotes, elks, and wolves, a set of energy game models are established in [
39]. The sheepdog assignment for the sheep-herding task is considered the fundamental inspiration in [
40], and the steering control laws are designed with the biological behavior of sheep herding, including aggregation and dispersion, and are validated through a wheeled robotic swarm. As a typical animal species that is well-known for its collective behavior when flying in flocks, pigeons have attracted widespread attention in the investigation of biomimicry [
41].
In a leader–follower interactive topology, trajectories for the leader are commonly determined by the system settings, and the followers are anticipated to form a desired formation pattern around the leader node. If the obstacles are distributed near the predefined trajectory, then the UAV clusters, especially the leader UAV, are blocked. Since the leader trajectory is set to be collision-free in the existing literature, collision avoidance protocols should be investigated for both the leader and followers in this work. Additionally, obstacle avoidance and the neighboring collision-free formation are required to be maintained at the same time. For the sake of combination with the formation control term, the collision-free controller is designed as a gradient-based form differentiated from the energy potential function. Therefore, a potential-field-based collision avoidance law inspired by the pigeon hierarchy principle is developed in this paper, resulting in guaranteeing cooperative collision evasion for the leader–follower formation.
In this paper, the leader–follower collision-free coordination framework is developed in three modules. An attitude consensus stabilization law composed of auxiliary error system is proposed at first to avoid the direct state feedback; namely, the applied torque can be synthesized without the quaternion and rotational angle measurement feedback while only introducing the auxiliary state error. Secondly, a pigeon-hierarchy-inspired leader–follower collision avoidance protocol for the leader and follower, respectively, is proposed, achieving coordinated and safe collision avoidance when meeting obstacles blocking the leader’s trajectory. Thirdly, a finite-time terminal sliding mode collision-free formation and reconfiguration control law is proposed by synthesizing the first two modules, attaining finite-time reconfiguration convergence.
To overcome the dilemma in designing control laws for the strong coupling kinematics in the clustered quadcopter UAV system, the cooperative formation-tracking scheme with obstacle avoidance is investigated in this paper. The main contributions are discussed as follows:
An auxiliary error system is established to achieve collaborative attitude convergence without direct state feedback in quaternion, rotation angles, and angular velocity, but the applied torque in the attitude consensus law is synthesized only by utilizing state-tracking errors or auxiliary errors. Aiming at reaching convergence in the attitude loop, an attitude consensus stabilization law (ACSL) is established by combining the adaptive angular rate command and the auxiliary error system to produce an applied torque, and thus cooperative attitude tracking can be reached under arbitrary initial quaternion and angular rate settings.
Inspired by the homing behavior of pigeon flocks, a pigeon-hierarchy-inspired collective obstacle avoidance protocol (PHOAP) is proposed in a hierarchical scheme. The energy function of the PF is designed to provide the repulsive control force for collision safety between UAVs and for obstacle avoidance. The leader target is driven by the obstacle repulsive protocol to regulate an appropriate trajectory. However, the follower UAVs are guided to track the desirable leader’s trajectories while achieving cooperative obstacle avoidance.
A terminal sliding mode (TSM) surface is developed based on lumped translational errors. Moreover, a finite-time formation control protocol (FTFCP) is elaborated by using the combination of TSM to guarantee formation consensus tracking within an upper finite-time bound related to the initial states in the translational loop. To synthesize the ACSL, the PHOAP, and the FTFCP based on TSM, the cooperative formation control and obstacle avoidance framework is attained and validated through typical simulation scenarios in this paper.
The rest of this paper is organized as follows.
Section 2 provides the preliminaries of graph theory and fundamental notation. The modeling of the UAV and the control objectives are also discussed.
Section 3 presents the controller design and provides the stability proof.
Section 4 displays the numerical simulation results, and
Section 5 summarizes the whole work.
2. Preliminaries and Problem Formulation
2.1. Preliminaries
First, a few significant notations and symbols: , , , and represent the fields of real numbers, positive real numbers, -dimensional (-D) column vectors, and matrixes of rows and columns, respectively. Subsequently, , , , and are the same for integers. For a vector , the 1-norm and 2-norm are separately denoted by and . Additionally, the power of a vector is . For the sliding mode design, the sign function is denoted as , while the signum function is depicted as . For ease of expression, the two terms above are represented by and . The skew-symmetric matrix for a vector is defined as . The operator represents the Kronecker product.
Since a leader–follower scheme is investigated, the interactive topology in this paper is divided into two layers. The first layer, that is, the topology between followers, is considered to be undirected, denoted as , where is the vertex set and is the edge set. If an edge from node to node exists, namely , then holds for an undirected graph. Moreover, the Laplacian matrix of
, whose -th diagonal element is , and at other locations. However, the information is regulated to be transferred in a fixed direction from the leader vertex to the followers under the second layer. Subsequently, the link weights are depicted by with representing that the link from the leader to follower node exists. The augmented Laplacian matrix is defined as .
Assumption 1. There exists at least one follower UAV that has access to the states of the leader vertex, namely . Under such circumstances, the augmented Laplacian matrix is guaranteed to be positive and definite [36]. The following theories are significant for the formation controller development in the translational loop of the UAV system.
Definition 1. Consider a nonlinear system whose dynamics are , with system state , , and . If there exists a function denoted as related to the initial state and a positive constant that can guarantee that holds for any , then the system is locally practically finite-time stable. Furthermore, if , then the system is globally practically finite-time stable [42]. Lemma 1. For the system , if we can find a positive definite function that is continuous in its domain and for which the inequality holds for , , and , then the system is consequently globally and practically finite-time stable [42]. Lemma 2. To avoid the singularity of the rotation matrix, a quaternion is introduced to be , where and . The inversion of a quaternion is defined in this paper as . Moreover, the relative deviation of two quaternions and is defined by . The translation from a quaternion to a rotation matrix is denoted as [43]. 2.2. Mathematical Model of UAV Cluster and Obstacle
The agent for the formation control issue in this paper is a quadcopter UAV. Since it is required to take off and land vertically, the system dynamics are often separated into two cascaded subsystems, that is, a rotational system and a translational system. The states of the rotational subsystem consist of the quaternion, angular velocity, and rotational matrix, denoted as
where
and
,
, and
, respectively. Moreover, the states in the translational system contain
and
. For any
, the follower UAV system dynamics are established as [
44]
where (1) and (2) are, separately, the rotational and translational updating laws of the UAV system differential equations,
is the quaternion updating matrix,
is the gravitational acceleration,
is the driven thrust,
is the mass of the rotorcraft, and
. The applied torque
and the thrust
need to be designed to maintain the stability of each UAV platform.
For the obstacle avoidance issue discussed in this paper, the effective region of the
-th obstacle and the detection region of the
-th UAV are separately defined as
where
represents the collision area of the
-th obstacle and
denotes the detection scope of the
-th UAV,
is the center position of the
-th obstacle, and
and
refer to the detection radius and the obstacle radius, respectively. It is obvious in (3) that the detection region of a UAV node is assumed to be a limited circular area.
Based on the definitions above, the obstacles detected by the
-th UAV node are summarized in a set as
2.3. Problem Formulation and Control Objectives
The translational command control input is defined as
, and similarly to the previous work [
32,
44],
is considered the rotation error matrix, where
is the command rotation matrix as shown by (11) in [
44]. The expression of
and
is substituted into the velocity dynamics in (2), thus obtaining
. For any
, the position- and velocity-tracking errors are defined as
and
, respectively, where
denotes the formation offset of the
i-th UAV, and
and
refer to the position and velocity of the maneuvering leader with simple dynamics as
Due to the requirement of suppressing the translational formation-tracking errors, the differential equations for the translational errors are elaborated as
When
holds, the angular-rate-tracking error is defined as
, with
being the command angular rate. Substituting it into (1), the error dynamics for the rotational loop are subsequently derived as
The main objectives in this paper can be divided into three cascaded parts, that is, to reach asymptotic convergence in the attitude loop, to ensure the practical finite-time stability of the translational loop, and to simultaneously avoid conflict between neighboring UAVs and collision with obstacles. In the attitude subsystem, and are required, and in the translational subsystem and are demanded for each to guarantee formation tracking when the UAV cluster is not influenced by any obstacles. However, when there exist obstacles, and are the safety constraints for , with an infinitesimal constant as the lower bound of the relative distance.
3. Main Results
In this section, the formation control laws and collision-free protocols are elaborated. Meanwhile, the detailed stability analysis is conducted for the attitude control laws and the translational formation control laws according to Lyapunov theories.
3.1. Attitude-Consensus-Tracking Protocol with Auxiliary System
Due to constraints in deriving the direct state feedback in the attitude system, auxiliary attitude error systems and adaptive command filter are elaborated in this section for achieving attitude stabilization with the lack of system state feedback. Therefore, the applied torque is developed by utilizing the relative quaternion obtained from monocular cameras or lasers to obtain relative information or by acquiring the attitude signal-tracking errors from onboard flight controller.
The auxiliary quaternion command is defined as
, with
and
. Similar to the quaternion-tracking error
, the auxiliary quaternion error is proposed as
by utilizing the auxiliary quaternion command. According to Lemma 2, the auxiliary rotation error matrix can be derived as
. Subsequently, an adaptive auxiliary command angular velocity
follows the updating law as
An auxiliary angular velocity error is defined in the same form of
as
. The expression
and
are substituted into (7), and
is employed. Since the newly designed variables of the auxiliary system are proposed, the auxiliary attitude error dynamics are depicted as
Moreover, the applied torque is synthesized with two terms: one is to guarantee the coordination of attitude tracking, while the other aims to compensate for the remaining items in (10), which are indicated by
where
is the vector term of the relative quaternion
. A remark is proposed here for the computation of
as
The quaternion-tracking error
is updated by
where the matrix
, and thus the two differential equations are obtained as
The attitude-tracking errors and the auxiliary variables are updated and integrated by (8)–(10) and (12)–(14). Then, the compensation term as well as the consensus control term are generated, and thus the applied torque is formulated based on the auxiliary error systems.
Remark 1. Due to the difficulty of deriving the explicit formula of the derivatives of the control input , a second-order sliding mode differentiator (SOSMD) is employed for estimating the first-order and second-order derivatives aswhere ,
, and are positive constants, and .
The estimation value of and are depicted separately by and . Then according to the computing methodology demonstrated in the appendix in [45], the command angular velocity and its derivative are obtained based on , and . Therefore, the compensation term in the applied torque can be determined. 3.2. Finite-Time Terminal Sliding Mode Formation Control
Regardless of the obstacles in the environment, an FTFCP based on the TSM is proposed for the translational subsystem to attain FT formation clustering, namely, to guarantee the stability of error system (6).
For any
, the lumped tracking errors of position and velocity are indicated as
The nonlinear TSM manifold is defined to be
where
is a constant and
denotes the signum item, which can guarantee the finite-time convergence of the lumped errors in (16).
Remark 2. Since is ultimately bounded for the FT convergence of the control input designed below, the coupling term will converge into zero if consensus tracking is achieved under (8) and (11). Only the term in (6) should be considered to compensate in the expression of .
An adaptive control gain is introduced to maintain the FT convergence property of TSM according to Lemma 1 as
where the constants satisfy
,
, and
. Subsequently, the FT formation control protocol is given as
where
,
, and
, which are both positive odd integers.
3.3. Obstacle Collision-Free Safety Control Inspired by Pigeon Behavior
The collision-free control for a leader–follower swarm structure is quite complex. Different from the common scenarios where obstacles partially block the followers but not the leader, the obstacles in this paper are predefined to be in the desired path of leader. Hence, the collision-free control scheme is required for both the leader and the followers. Inspired by the homing behavior of pigeon flocks, the repulsive control force is generated hierarchically, the same as the interaction mechanisms in pigeon flocks when a large maneuvering turn occurs after negotiation among the social hierarchy in a pigeon flock [
41]. Considering that the obstacle avoidance methodology needs to be designed according to the leader–follower social hierarchical relationship, a PHOAP is proposed given the gradients of the potential field as repulsive interactions.
Since the maneuvering leader possesses the dynamics of a second-order particle that is simply ordered to follow the desired path with a continuous function, it can be simply driven by a repulsive virtual force from the obstacle entering its detection region. Moreover, for the aid of achieving formation reconfiguration after obstacle avoidance, a linear tracking law is attached to the control input. A non-repulsive region is defined for the leader UAV as
where
represents the set composed of threatened obstacles.
If
for a leader UAV according to the definition in (4) in
Section 2, then the repulsive PF is required for the task. An available PF is proposed to avoid obstacles as
Remark 3. The collision-free control between the leader layer and the follower UAV layer is assumed to be ignored in the aspect of the leader in this paper. Consequently, there exists no repulsive control for the leader from any followers; only from obstacles. However, a collision avoidance protocol needs to be designed for the followers to avoid colliding with both the leader and other neighboring followers.
The obstacle avoidance law based on the potential field and the reconfiguration-tracking protocol are combined to establish a command acceleration
for the leader UAV as the control input as
where the gradient is calculated as
with
,
is the signal for reference acceleration generation, and
drives the leader UAV to track the reference trajectory when
.
denotes the obstacle avoidance control gain, and
and
are the consensus-tracking gains.
On the other hand, the collision-free design for any follower UAV is elaborated as follows. The neighbor sets for the collision avoidance between UAVs and obstacle avoidance are defined as
where
denotes the set for UAVs that enter the detection region of UAV vertex
, and
denotes the set of obstacles in the detection scope of UAV
.
Two repulsive PFs are proposed for the aid of collision avoidance and obstacle evasion, respectively, as
By deriving the gradients of the PFs, the control protocols for both collision avoidance and obstacle evasion are indicated as
Remark 4. The collision-free PF-based controllers (22) and (25) that can provide a repulsive effect are analyzed. Since satisfies , namely, since the expression holds, then , an obstacle avoidance protocol for the leader UAV in (22), works as a virtual force and has the same direction as the vector . Similar to , the repulsive control input for each individual, namely and , can achieve the same direction with and , respectively, which means that the virtual forces have repulsive abilities.
Therefore, for all the followers
, the two repulsive control input terms for collision-free design are attached to (19) to achieve collision-free formation-tracking control, which is denoted as
3.4. Stability Analysis
In this section, except for the PHOAP proposed for collision-free control, the cascaded formation control framework is composed of the ACSL for attitude tracking and the FTFCP based on TSM for translational stabilization. Two theorems are presented in this section: one is for the proof of the asymptotic convergence reached in the rotational control by the applied torque (11), and the other is for the FT convergence reached in the translational control by the command force (19). Then, the stability of the cascaded UAV dynamic system is obtained.
Theorem 1. Consider the applied torque (11) with the auxiliary rotational systems (8)–(14) on the rotational error dynamics (7). If the control gains satisfy , then the attitude-tracking errors will remain ultimately bounded, and the quaternion and angular velocity state errors will reach asymptotic convergence as and .
Theorem 1 draws the conclusion that the rotational errors can reach convergence asymptotically under the proposed applied torque and the auxiliary rotational error system. The proof of Theorem 1 is given as follows.
Proof of Theorem 1. A positive definite Lyapunov candidate is considered aswhere is obtained through (12), is updated by (14), and is updated by the adaptive auxiliary system dynamics (8). Since the factors and , which are obvious to perceive, the positive definite nature of (27) is guaranteed. The derivative of the first term in (27), denoted as
, can be obtained by calculating the left multiplication of
with (10) and substituting the applied torque (11) into (10)
where the homogenous terms are merged, and some specific coupling terms are removed. The following Lemma in (28) is employed, and it can be simplified in another step.
Lemma 3. For a quadratic form , where is a vector and is a skew-symmetric matrix, the following relationship holds: (1) ; (2) the transposition of the quadratic form equals itself: . holds if is a skew-symmetric matrix according to (1) and (2). Additionally, holds for any .
According to Lemma 3, (28) is transformed into
where
is proved to be a skew-symmetric matrix so that
is a quadratic form.
From (12) and (14), we can obtain the differential equation
, with
and
. According to the derivations above and Lemma 2,
holds, so
. The derivative of
in (27) can be formulated as
The derivative of (27) is taken, (29) and (30) are substituted into (27), and finally the derivative of Lyapunov candidate (27) is obtained as
According to the final conclusion
drawn from (31), namely the negative semidefinite of the Lyapunov derivative, it can be seen that
,
, and
are ultimately bounded for any follower UAVs
. From (8) and the definition of
, we can derive that the terms
and
are also ultimately bounded, respectively. The convergence of
can be obtained by employing the Barbalat Lemma [
45] and the globally bounded properties of
and
. Then, the derivative of (8) is taken, and
is determined to be bounded. Then,
and
are consequently derived, which indicates
according to (11). Since the relationship
exists,
is acquired. From
we can obtain that
is globally bounded, and thus the convergence of
is proved. Therefore,
is apparently converged so that
. Furthermore, the angular velocity error is denoted as
. Since
and
hold,
is derived. Then, the proof of Theorem 1 is completed.
According to Remark 2, the coupling term will converge to zero for the bounded property of and in Theorem 1. Then, the stability of translational error subsystem (6) is related only to the convergence of error terms and . The FTFCP based on TSM is proved to maintain the practical FT convergence of the translational formation-tracking error, which is elaborated in Theorem 2.
Theorem 2. The employed translational formation-tracking error system denoted by (6) is considered. Considering a leader–follower interactive topology where followers are connected with undirected links, if Assumption 1 is satisfied, then the command force (19) and the adaptive law (8) will guarantee the translational formation-tracking errors of position and velocity, namely and , to achieve practical finite-time convergence under the parameter settings in (19) as , , and are both positive odd integers. A positive definite Lyapunov candidate is defined aswhere the adaptive error term , and the stacked form of the TSM surface is .
The terms and above are the stacked lumped tracking errors of position and velocity, denoted by with , and with . Moreover, the stacked differential equations are expressed as and , with as the stacked command force. The setting time for system (6) holds an upper bound according to the initial value of and the constant scalar aswhere is the initial time stamp, and is the initial value of (32). Moreover, the system errors , , and will be driven into a residual set as will be elaborated in the proof of this theorem. The other coefficients in (33) and (34) are depicted by The FT stability and how the adaptive FTFCP achieves rapid tracking of the UAV clusters under an undirected communication topology are discussed Theorem 2. The proof of Theorem 2 is given as follows.
Proof of Theorem 2. A positive definite Lyapunov function such as (32) is chosen. The stacked control input and the TSM derivative are denoted aswhere ,
,
,
, and denotes a column vector of 1. The matrix is defined as , and , with . Then, (36)–(38) are substituted into the derivative of (32) and yield
Lemma 4. For any vector , holds.
According to Lemma 4,
. Since Assumption 1 holds, the auxiliary Laplacian matrix satisfies
and
. Furthermore,
holds for a positive definite symmetric Laplacian matrix
. Therefore, the first term in (39) is scaled by
Since
, the second term in (39) is formulated as
The third term in (39) can be scaled as
The stacked form of the TSM surface (17) is substituted into the fourth term in (39), yielding
For the fifth term in (39), the following deduction holds
The conclusions drawn by (40)–(44) are combined and substituted into (39), yielding
where
is obviously ensured. According to Lemma 1, it can be deduced that the translational error system (6) is globally and practically finite-time stable. The settling time and residual region in Theorem 2 are calculated by referring to Lemma 2 and Corollary 1 in [
43]. From Remark 1 in [
43], we can further ensure the TSM manifold (17) is globally finite-time stable. Then, apparently the formation-tracking errors can reach the convergence region in finite time, as Theorem 1 holds according to Remark 2. The proof of Theorem 2 is completed.
4. Discussion
The numerical simulation is conducted in three scenarios. The proposed ACSL and FTFCP are validated through the first scenario of formation tracking without obstacles, and the PHOAP is embedded in the formation control protocol and tested under the second scenario of cooperative obstacle avoidance.
Scenario 1: The leader UAV is commanded to track the reference trajectory. The desired acceleration as an input to the leader is generated by , and the velocity is derived from the integral of with an initial constant vertical speed of . Five followers are considered to perform formation tracking with a desired formation pattern such as . The UAVs are chosen as quadcopters with vertical takeoff, the mass of each personal UAV is kg, and the inertia matrix is set as . The initial states are set as follows: The initial position vectors are , , , , and . The initial velocity vectors are for any . The initial quaternion vectors are , and the angular velocity vectors are .
The parameters of the ACSL are set as
,
, and
. Then, the parameters for TSM are set as
,
,
, and
for the adaptive law. For the FTFCP, the parameters are predefined as
,
,
, and
. In Scenario 1, the attitude-tracking results by the ACSL are plotted in
Figure 1.
It can be deduced from
Figure 1 that the tracking error is suppressed into low levels in less than 8 s, and the errors in the auxiliary system converge rapidly, which can fulfill the attitude control objectives. Furthermore, the initial quaternion and angular rate can be set to a non-zero value, which indicates that the ACSL is not sensitive to the initial state values, and this property exceeds many attitude-tracking laws provided in other studies.
The 3D formation-tracking result is plotted in
Figure 2, and the TSM curves and tracking errors of position and velocity are shown in
Figure 3.
According to
Figure 2 and
Figure 3, formation consensus tracking can be achieved in less than 4 s, and the formation control errors in position and velocity are both suppressed to a lower level and converge to zero, just as the analysis in Theorem 2.
Scenario 2: The purpose is to validate the effectiveness of the collision-free control framework including the ACSL, FTFCP, and PHOAP. The reference trajectory is set as the same in Scenario 1. Additionally, the obstacle collision avoidance control law denoted by (20)–(22) is introduced to adjust the motion of the leader UAV. Collision-free control is employed in each follower UAV according to (18), (19), and (23)–(26). Two static obstacles are set to block the desired trajectory at
with
, and
with
. The control parameters in the collision-free protocol are set as
,
,
,
,
,
, and
. The control results are shown in
Figure 4 and
Figure 5.
It can be deduced from
Figure 4 that the UAV formations can evade the existing obstacles, which are blocking the desired path. After avoiding the obstacles, the follower UAVs can rapidly complete the formation pattern reconfiguration around the maneuvering leader target. The relative distance is displayed, which intuitively displays the obstacle evasion and the collision avoidance results in Scenario 2. The proposed methodology is verified to be superior in collision-free control, formation consensus tracking, and formation reconfiguration.
Scenario 3: Another simulation with more obstacles distributed along the predefined trajectories of the UAV cluster is conducted, where the follower UAVs are governed by a completely different formation configuration. In this scenario, one leader node and six follower nodes are considered a leader–follower UAV cluster, defining an interactive topology of
and
, and the transmission form between followers are set as an undirected topology with
. The standard formation configuration without considering the obstacles are indicated as
Furthermore, the obstacles are set to locate at
The simulation is conducted in anticipation of a formation pattern according to (46) and an obstacle distribution according to (47). Then, the reference trajectory of the leader UAV is set to be the same as in Scenario 1. To display the simulation results, the three-dimensional collision-free formation trajectories are illustrated in subplots (a) and (b) in
Figure 6, and the tracking errors of position and velocity are shown by the latter two subplots in
Figure 6, respectively.
It can be determined from
Figure 5 that collision-free reconfiguration formation control can be maintained among complex obstacles, and the robustness and stability hold for different formation patterns.
To sum up the methodology design and the simulation results of both formation and obstacle avoidance reconfiguration control, the research conducted in this paper has several superior points indicated as follows. Firstly, unlike [
27,
32,
43,
44,
45], the initial attitude states in this paper can be set as arbitrary values and are finally regulated to the desired value. Moreover, there is no requirement of the direct state feedback of the quaternion, angular velocity, and rotation matrix when implementing auxiliary error systems in this paper. Secondly, a pigeon-hierarchy-inspired collision-free protocol based on potential field gradients is proposed. Unlike [
13,
14,
15,
16], the leader–follower structure is considered in formation obstacle avoidance, and the leader’s trajectory is predefined and only adjusted by the virtual potential repulsive force, which maintains the computational efficiency compared with collision avoidance via optimization or random search methodology. Finally, finite-time convergence can be guaranteed in the position loop control, which exceeds those studies that only remain asymptotically stable. Moreover, the adaptive updating law and terminal sliding mode are employed to facilitate the convergence speed and the robustness of reconfiguration.