Optimization Algorithm for Drone Formation Consensus Based on Motion Constraints

In recent years, drone formations have garnered significant attention due to their advantages in military and civilian applications, such as surveillance, search and rescue, and light shows. The coordination of multiple drones in a drone formation poses challenges, especially under motion constraints like speed and acceleration limits. My research focuses on optimizing consensus control algorithms for drone formations to achieve specified formations while adhering to these constraints. This article presents my work on designing an enhanced second-order consensus formation control algorithm that incorporates virtual reference points and saturation functions to handle motion constraints effectively.

The foundation of drone formation control lies in multi-agent systems theory, where consistency in position and velocity among drones is crucial. Traditional second-order consensus algorithms often lead to drones converging to a single point rather than a desired formation, and their convergence states depend on initial conditions. To address these issues, I introduce a virtual reference point into the consensus algorithm, enabling the drone formation to converge to a predefined shape. Furthermore, by integrating saturation functions, I ensure that the control inputs respect the physical limits of each drone, such as maximum speed and acceleration. This approach not only improves formation accuracy but also enhances practicality for real-world drone formation operations.

To model a drone formation, I consider a group of n drones represented as nodes in a communication graph. The graph topology defines how information is shared among drones, which is essential for achieving consensus. Let me define the weighted adjacency matrix A and the Laplacian matrix L based on the distances between drones. For drone i, its dynamics can be simplified to a kinematic model in a ground-fixed coordinate system (e.g., East-North-Up). The position and velocity of drone i are denoted as si and vi, respectively, with control inputs subject to constraints. The drone formation must converge to a target formation defined relative to a virtual reference point, which moves along a desired trajectory. This setup allows me to design control algorithms that ensure the drone formation maintains its shape while following the reference point.

The relative kinematics of the drone formation are described using two coordinate systems: the ground-fixed system and the formation reference point heading system. By defining position and velocity coordination variables, I can track errors between drones and the virtual reference point. For drone i, the coordination variables are:

$$ \tilde{s}_i = s_i – s_i^I, \quad \tilde{v}_i = v_i – v_i^I $$

where siI and viI are the ideal position and velocity based on the formation geometry. The goal is to drive these coordination variables to zero, ensuring the drone formation converges to the desired formation. This framework is critical for developing consensus-based control algorithms that are robust to initial conditions and motion constraints.

In standard second-order consensus control for a drone formation, the dynamics are given by:

$$ \dot{s}_i = v_i, \quad \dot{v}_i = u_i $$
$$ u_i = \sum_{j \in N_i} A_{ij} \left[ (s_j – s_i) + \gamma (v_j – v_i) \right] $$

where γ is a velocity coupling coefficient. However, this algorithm causes drones to converge to a consensus position that depends on initial values, which is undesirable for maintaining a specific drone formation shape. To overcome this, I incorporate a virtual reference point with desired position s∗ and velocity v∗. The enhanced algorithm becomes:

$$ \dot{s}_i = v_i, \quad \dot{v}_i = u_{i2} $$
$$ u_{i2} = \sum_{j \in N_i} A_{ij} \gamma \left[ (v_j – v_i) + \alpha (v^*_i – v_i) \right] + \sum_{j \in N_i} A_{ij} \left[ (s_j – s_i + r_{ij}) + \alpha (s^* – s_i + r^I_i) \right] $$

Here, α is a reference state coupling coefficient, and rij is the desired formation offset between drones i and j. This algorithm ensures that the drone formation asymptotically converges to the target formation, independent of initial conditions, as proven using matrix theory. The convergence condition requires the communication graph to be undirected and connected, with γ > 0 and α > 0.

To address motion constraints in a drone formation, such as speed and acceleration limits, I introduce saturation functions into the control input. The constrained algorithm is:

$$ \dot{\hat{s}}_i = \hat{v}_i, \quad \dot{\hat{v}}_i = \hat{u}_{i4} $$
$$ \hat{u}_{i4} = \text{SAT}(\hat{u}_{i2}) $$

where SAT(·) is a saturation function defined as:

$$ \text{SAT}(u) = \begin{cases} c_{\text{max}}(t), & u > c_{\text{max}}(t) \\ u, & c_{\text{min}}(t) \leq u \leq c_{\text{max}}(t) \\ c_{\text{min}}(t), & u < c_{\text{min}}(t) \end{cases} $$

The bounds cmax(t) and cmin(t) are derived from the drone’s maximum and minimum speeds and accelerations, ensuring that control inputs remain within feasible limits. This approach maintains asymptotic convergence of the drone formation while respecting real-world constraints, though it may slightly slow down convergence due to reduced control authority.

For practical implementation, I design controllers for altitude, heading, and velocity channels in the drone formation. The altitude and heading controllers use PID control based on error tracking, while the velocity channels (East and North) employ the constrained consensus algorithm. The control inputs are integrated over time to generate continuous commands for each drone. This modular design allows the drone formation to execute tasks like formation assembly, maintenance, and transformation under various constraints.

To validate the algorithm, I conduct simulation experiments for a drone formation assembly scenario. The simulations involve five drones with different initial positions and velocities, aiming to converge to a predefined formation. I compare the performance of the proposed algorithm with other methods, such as standard consensus with saturation and algorithms using hyperbolic tangent functions for constraints. The results are summarized in tables to highlight convergence times and errors.

The simulation setup includes the following parameters: target altitude of 5 m, target heading of 90°, target velocity of [4, 0, 0] m/s, speed limits of 0-5 m/s, acceleration limits of 0-5g, and communication topology defined by a Laplacian matrix. The desired formation in the reference coordinate system is specified as offsets from the virtual reference point. Table 1 outlines the formation geometry for the drone formation.

Table 1: Desired Formation Geometry for Drone Formation
Drone Index East Offset (m) North Offset (m) Altitude Offset (m)
1 0 0 0
2 5 -5 0
3 -5 -5 0
4 10 -10 0
5 -10 -10 0

In the simulations, I test four scenarios: two with different initial formations using a baseline algorithm, and two with the proposed algorithm. The convergence times and iteration counts are shown in Table 2. The drone formation with the proposed algorithm converges faster and more accurately to the desired shape, demonstrating the effectiveness of the virtual reference point and saturation functions.

Table 2: Convergence Performance for Drone Formation Simulations
Simulation Case Convergence Time (s) Iteration Count Key Observation
Baseline Algorithm (Initial Set 1) 107.777 5389 Drones converge to a point, not formation
Baseline Algorithm (Initial Set 2) 109.798 5490 Similar issues with dependency on initials
Proposed Algorithm (Initial Set 1) 95.180 4759 Accurate convergence to formation
Proposed Algorithm (Initial Set 2) 98.773 4939 Consistent formation achievement

The position and velocity errors at convergence are detailed in Table 3. The proposed algorithm achieves errors below 0.5 m in position and 0.01 m/s in velocity, confirming its precision. In contrast, the baseline algorithm shows larger errors and fails to maintain the drone formation shape. These results underscore the importance of incorporating virtual reference points and motion constraints in consensus control for drone formations.

Table 3: Position and Velocity Errors at Convergence for Drone Formation
Simulation Case Max Position Error (m) Max Velocity Error (m/s) Formation Accuracy
Baseline Algorithm (Set 1) 95.661 0.4396 Poor
Baseline Algorithm (Set 2) 118.676 0.4433 Poor
Proposed Algorithm (Set 1) 0.346 0.0087 High
Proposed Algorithm (Set 2) 0.374 0.0037 High

Further comparisons with other constraint methods, such as using hyperbolic tangent functions, reveal that the saturation function approach offers better performance in terms of convergence speed and accuracy. Table 4 summarizes a comparative study where the proposed algorithm reduces convergence time by over 20% compared to alternatives, highlighting its efficiency for real-time drone formation control.

Table 4: Comparative Analysis of Constraint Methods for Drone Formation
Algorithm Type Convergence Time (s) Iteration Count Remarks on Drone Formation
Proposed Algorithm with Saturation 95.378 4769 Fast and accurate formation
Algorithm with Hyperbolic Tangent 201.530 10077 Slow convergence due to nonlinearity
Baseline with Saturation 129.630 6482 Moderate performance
Unconstrained Algorithm 93.971 4699 Fast but impractical for real drones

The stability analysis of the proposed algorithm involves examining the eigenvalues of the system matrix. For the drone formation under motion constraints, I prove that the system remains asymptotically stable as long as the communication graph is connected and control parameters are positive. The saturation function introduces a time-varying gain matrix F(t), but the eigenvalues stay negative, ensuring convergence. This theoretical guarantee is crucial for deploying drone formations in dynamic environments where constraints must be strictly enforced.

In practice, the drone formation controller computes control inputs for each drone at every time step. The altitude controller uses PID action on the altitude error:

$$ \dot{z}_i = k_{zp} \tilde{z}_i + k_{zi} \int_0^t \tilde{z}_i \, d\tau + k_{zd} \frac{d\tilde{z}_i}{dt} $$

Similarly, the heading controller adjusts the yaw angle based on heading error. The velocity controllers for East and North directions apply the constrained consensus algorithm, with saturation bounds computed from the drone’s speed and acceleration limits. For example, the East acceleration constraint is:

$$ \ddot{x}_{i,\text{max}} = \sqrt{ a_{\text{max}}(i)^2 – \ddot{y}_i^2 – \ddot{z}_i^2 } $$

These constraints ensure that the drone formation maneuvers safely without exceeding physical capabilities. The integrated control system enables complex drone formation tasks, such as coordinated turns and altitude changes, while maintaining formation integrity.

My research demonstrates that the optimized consensus algorithm effectively addresses the limitations of standard methods for drone formation control. By integrating virtual reference points and saturation functions, the algorithm ensures that the drone formation converges to a desired shape regardless of initial conditions and adheres to motion constraints. The simulation results validate its superiority in terms of convergence speed and accuracy, making it suitable for applications like aerial displays, environmental monitoring, and collaborative payload transport. Future work could extend this approach to three-dimensional formations, dynamic topology changes, and robust control under disturbances, further advancing the capabilities of autonomous drone formations.

The implications of this work are significant for the field of multi-drone systems. As drone formations become more prevalent in various industries, reliable control algorithms are essential for safety and efficiency. The proposed method offers a scalable solution that can be adapted to different formation geometries and constraint profiles. By leveraging consensus theory and practical saturation techniques, it bridges the gap between theoretical control design and real-world implementation, paving the way for more sophisticated drone formation applications in the future.

Scroll to Top