Design of Anti-jamming Attitude Control System for Quadrotor Drone Based on Hybrid Filtering

In recent years, unmanned aerial vehicles (UAVs) have become increasingly prevalent across various domains, with rotary-wing and flapping-wing types gaining significant traction. Among these, the quadrotor drone stands out due to its simplicity of operation, ability to hover, high maneuverability, and ease of maintenance. These attributes make the quadrotor drone indispensable in both commercial and civilian applications. However, the quadrotor drone is highly susceptible to external disturbances such as electromagnetic interference, wind gusts, and linear perturbations, which can severely degrade its flight performance, particularly in attitude control. Traditional anti-jamming attitude control systems for quadrotor drones often exhibit inadequate disturbance rejection and poor control performance, leading to instability and unreliable operation. To address these limitations, this paper proposes an anti-jamming attitude control system for quadrotor drones based on hybrid filtering. The system optimizes both hardware and software components to enhance robustness, control precision, and response speed. Through extensive experimentation, the proposed system demonstrates superior anti-jamming capability, high control accuracy, and fast dynamic response compared to conventional methods.

The quadrotor drone operates by adjusting the rotational speeds of its four motors to achieve desired attitudes and trajectories. Attitude control is fundamental to stable flight, as it governs the drone’s orientation—roll, pitch, and yaw. External disturbances can introduce errors in attitude estimation, leading to control failures. Therefore, developing an effective anti-jamming attitude control system is critical. This system leverages hybrid filtering techniques to fuse data from multiple sensors, mitigate noise, and provide accurate real-time attitude angles. The integration of advanced hardware components and sophisticated software algorithms ensures that the quadrotor drone can maintain stability even in challenging environments. The following sections detail the system’s design, implementation, and validation.

The overall architecture of the anti-jamming attitude control system for the quadrotor drone comprises hardware and software modules. The hardware includes a main controller, sensor modules, motor drive modules, and wireless data transmission modules. The software encompasses attitude estimation via hybrid filtering, attitude control algorithms, and a cascade PID control strategy. The synergy between these elements enables the quadrotor drone to resist disturbances and achieve precise attitude control. The system is designed to be modular, scalable, and adaptable to various quadrotor drone platforms. Key innovations include the use of dual gyroscopes and dual accelerometers to avoid resonance effects, hybrid filtering for sensor data fusion, and cascade PID for enhanced control stability. The subsequent paragraphs elaborate on each component.

Hardware Design of the Quadrotor Drone Anti-jamming Attitude Control System

The hardware foundation of the quadrotor drone anti-jamming attitude control system is critical for reliable operation. It consists of several interconnected modules: power module, main controller, sensor module, motor drive module, and wireless data transmission module. Each module is optimized for performance, durability, and minimal interference. The quadrotor drone’s hardware must withstand vibrational stresses, electromagnetic noise, and environmental factors while providing accurate data and responsive control. Below is a summary of the hardware components in a table format.

Table 1: Hardware Components of the Quadrotor Drone Anti-jamming Attitude Control System
Module Component Specifications/Function
Power Module Lithium Battery, Voltage/Current Sensor Provides energy supply and monitors power parameters.
Main Controller Microprocessor (e.g., ARM-based) Processes data, generates PWM signals, coordinates modules. Features SPI, USB, UART interfaces.
Sensor Module Dual Gyroscopes (MPU6000, LSM6DS3), Dual Accelerometers, GPS, Barometric Altimeter Measures attitude angles, angular rates, acceleration, position, and altitude. Dual sensors avoid resonance.
Motor Drive Module Brushless DC Motor (X2216), ESC (60A) Drives quadrotor drone propellers with high speed and response.
Wireless Data Transmission 3DR Wireless Module Transmits real-time attitude and position data to ground station.

The main controller serves as the brain of the quadrotor drone. It is equipped with a high-performance microprocessor capable of operating at elevated frequencies to expedite data processing. The controller integrates multiple clock generators that output PWM wave signals to regulate motor speeds. To enhance reliability, a co-processor is embedded to assist in attitude control tasks if the main processor fails due to interference. This redundancy ensures that the quadrotor drone can maintain stability even under adverse conditions. The controller’s interfaces, such as SPI and UART, facilitate seamless communication with other hardware modules, enabling rapid data exchange and control command execution.

The sensor module is pivotal for accurate attitude estimation. It includes inertial measurement units (IMUs) comprising dual three-axis gyroscopes and dual three-axis accelerometers. The gyroscopes measure angular velocities, while accelerometers measure linear accelerations. By employing dual sensors, the system can cross-validate data and mitigate errors induced by resonance or sensor failures. Additionally, a GPS module provides global positioning data, and a barometric altimeter measures altitude. These sensors collectively supply the necessary data for determining the quadrotor drone’s orientation and position. The sensor fusion algorithm, implemented in software, leverages this data to compute precise attitude angles.

The motor drive module is responsible for actuating the quadrotor drone’s propellers. It utilizes brushless DC motors known for their efficiency and durability. The selected motor, model X2216, offers high rotational speed and quick response, which are essential for agile maneuvers. The electronic speed controller (ESC) regulates motor speed based on PWM signals from the main controller. The ESC’s high current rating (60A) ensures sufficient power delivery, enabling the quadrotor drone to respond promptly to control inputs. This module is designed to minimize electromagnetic interference, which could otherwise disrupt sensor readings.

The wireless data transmission module enables real-time monitoring of the quadrotor drone’s flight data. The 3DR wireless module operates at frequencies up to 500 MHz with a power output of 450 mW, ensuring reliable communication over distances. It interfaces with the main controller via SPI, benefiting from high-speed data transfer capabilities. This module transmits attitude information, position data, and system status to a ground station, allowing operators to monitor and intervene if necessary. The wireless link is encrypted to prevent jamming and unauthorized access, further enhancing the quadrotor drone’s anti-jamming capabilities.

Software Design and Hybrid Filtering Algorithm

The software component of the quadrotor drone anti-jamming attitude control system is designed to process sensor data, estimate attitude, and execute control commands. The core of the software is a hybrid filtering approach that combines complementary filtering with data fusion techniques to achieve accurate and robust attitude estimation. This is complemented by an attitude control algorithm and a cascade PID control strategy to ensure stable flight. The software operates in real-time, with algorithms optimized for computational efficiency to meet the stringent timing requirements of the quadrotor drone.

The attitude estimation process begins with reading raw data from the sensors. The gyroscopes provide angular rate measurements, which can be integrated to obtain attitude angles. However, gyroscopes suffer from drift over time due to bias and noise, leading to low-frequency errors. Accelerometers, on the other hand, provide gravity-based attitude estimates but are prone to high-frequency noise from vibrations. To address these issues, a hybrid filter is employed. The filter fuses gyroscope and accelerometer data using a complementary filter structure, which combines the high-frequency response of the gyroscope with the low-frequency stability of the accelerometer. The mathematical formulation of the complementary filter for pitch angle estimation is as follows:

$$
\theta_{filtered}(t) = \alpha \cdot (\theta_{gyro}(t) + \int \omega_y(t) \, dt) + (1 – \alpha) \cdot \theta_{accel}(t)
$$

where $\theta_{filtered}(t)$ is the filtered pitch angle at time $t$, $\theta_{gyro}(t)$ is the gyroscope-derived angle, $\omega_y(t)$ is the angular rate around the y-axis, $\theta_{accel}(t)$ is the accelerometer-derived angle, and $\alpha$ is a weighting factor typically between 0 and 1. For the quadrotor drone, this filter is applied to roll, pitch, and yaw angles. The weighting factor is tuned based on sensor characteristics and operational conditions. Additionally, the hybrid filter incorporates data from dual sensors to further reduce errors. The fusion process can be represented as:

$$
\theta_{fused} = \beta \cdot \theta_{gyro1} + (1 – \beta) \cdot \theta_{gyro2} + \gamma \cdot \theta_{accel1} + (1 – \gamma) \cdot \theta_{accel2}
$$

where $\beta$ and $\gamma$ are fusion coefficients optimized via calibration. This approach minimizes the impact of sensor-specific anomalies and enhances the reliability of attitude estimation for the quadrotor drone.

Following attitude estimation, the control algorithm generates commands to adjust the quadrotor drone’s motors. The attitude control algorithm computes desired motor speeds based on the error between the estimated attitude and the desired attitude. A cascade PID control strategy is employed to improve disturbance rejection. The cascade structure consists of an outer loop for attitude control and an inner loop for rate control. The outer loop PID controller processes attitude errors and outputs desired angular rates, which are then fed into the inner loop PID controller to compute motor thrusts. The control law for the outer loop can be expressed as:

$$
\omega_{desired} = K_{p,outer} \cdot e_{attitude} + K_{i,outer} \cdot \int e_{attitude} \, dt + K_{d,outer} \cdot \frac{de_{attitude}}{dt}
$$

where $\omega_{desired}$ is the desired angular rate, $e_{attitude}$ is the attitude error, and $K_{p,outer}$, $K_{i,outer}$, $K_{d,outer}$ are PID gains. The inner loop control law is:

$$
T_{motor} = K_{p,inner} \cdot e_{rate} + K_{i,inner} \cdot \int e_{rate} \, dt + K_{d,inner} \cdot \frac{de_{rate}}{dt}
$$

where $T_{motor}$ is the motor thrust, $e_{rate}$ is the angular rate error, and $K_{p,inner}$, $K_{i,inner}$, $K_{d,inner}$ are inner loop PID gains. This cascade approach decouples the dynamics, allowing for tighter control and better anti-jamming performance. The PID gains are tuned using simulation and experimental testing to ensure optimal response for the quadrotor drone. The software also includes fail-safe mechanisms and adaptive tuning to handle varying disturbance levels.

The software implementation is structured as a state machine with periodic interrupts. The main loop initializes the system, reads sensor data, performs attitude estimation, executes control algorithms, and outputs PWM signals. The interrupt service routines handle time-critical tasks such as sensor data acquisition and wireless communication. The code is written in C/C++ for efficiency and portability. To illustrate the software workflow, consider the following table summarizing the key steps.

Table 2: Software Workflow for Quadrotor Drone Anti-jamming Attitude Control
Step Action Description
1 System Initialization Initialize hardware modules, set up interrupts, and calibrate sensors.
2 Sensor Data Acquisition Read data from gyroscopes, accelerometers, GPS, and altimeter via SPI/I2C.
3 Data Preprocessing Apply calibration offsets, scale factors, and noise filtering to raw data.
4 Hybrid Filtering Fuse sensor data using complementary filter to compute attitude angles.
5 Attitude Control Compute attitude errors and execute cascade PID to generate control signals.
6 Motor Control Convert control signals to PWM duty cycles and drive motors via ESC.
7 Data Transmission Transmit attitude and status data wirelessly to ground station.
8 Loop Monitoring Check for system faults, adjust parameters adaptively, and repeat from step 2.

This structured approach ensures that the quadrotor drone can maintain stable flight while resisting disturbances. The hybrid filtering algorithm is central to this, as it provides accurate attitude estimates that are crucial for effective control.

Experimental Validation and Performance Analysis

To evaluate the effectiveness of the proposed anti-jamming attitude control system for the quadrotor drone, a series of experiments were conducted. The experiments aimed to assess the system’s anti-jamming capability, control accuracy, and response speed under various disturbance conditions. The performance was compared with a traditional attitude control system that uses conventional PID control without hybrid filtering. The experimental setup involved a custom-built quadrotor drone equipped with the designed hardware and software. Disturbances were simulated using Gaussian white noise injected into the control channels, mimicking real-world interference such as electromagnetic noise and wind gusts.

The experiments were performed in a controlled indoor environment to isolate external factors. The quadrotor drone was tasked with maintaining a hover attitude while disturbances were applied. Data on roll, pitch, and yaw angles were recorded at a high sampling rate. Key performance metrics included attitude error, settling time, overshoot, and disturbance rejection ratio. The results were analyzed quantitatively and qualitatively to demonstrate the advantages of the hybrid filtering-based system. Below is a table summarizing the experimental parameters.

Table 3: Experimental Parameters for Quadrotor Drone Testing
Parameter Value/Description
Quadrotor Drone Model Custom-built with 400 mm diagonal wheelbase
Sensor Sampling Rate 2 kHz for IMU, 10 Hz for GPS
Disturbance Type Gaussian white noise with mean 0, variance 10
Control Frequency 200 Hz
Testing Duration 60 seconds per trial
Comparison System Traditional PID-based attitude control

The first experiment evaluated the anti-jamming performance by injecting noise into the yaw channel. The yaw angle responses of both systems were recorded. The proposed system maintained a yaw angle of approximately 0.25 rad with minimal deviation, while the traditional system exhibited significant fluctuations, initially at 0.33 rad, then dropping to 0.20 rad before stabilizing at 0.25 rad. This indicates that the hybrid filtering approach effectively suppresses high-frequency noise, ensuring smoother attitude control for the quadrotor drone. The disturbance rejection capability can be quantified using the variance of the attitude error. For the proposed system, the variance was calculated as 0.0015 rad², whereas the traditional system had a variance of 0.0042 rad², demonstrating a 64% improvement.

The second experiment focused on roll angle control under a sudden disturbance torque. A large external torque was applied to both systems during stable hover. The traditional system experienced severe instability, with the roll angle jumping to 200 rad and remaining there due to coupling effects, leading to a complete loss of control. In contrast, the proposed system showed only a minor transient deviation, quickly recovering to the original roll angle. This resilience is attributed to the cascade PID control and hybrid filtering, which provide robust disturbance rejection. The recovery time for the quadrotor drone with the proposed system was measured at 0.5 seconds, compared to over 5 seconds for the traditional system (which ultimately failed).

The third experiment assessed control performance by tracking a desired roll angle trajectory. The desired roll angle was varied sinusoidally between -1° and +1°. Both systems were evaluated based on tracking error and response smoothness. The proposed system closely followed the desired trajectory with a root mean square error (RMSE) of 0.05°, while the traditional system had an RMSE of 0.15°. Moreover, when the attitude angle exceeded 1°, the traditional system exhibited large oscillations, whereas the proposed system maintained stable tracking. This highlights the enhanced control precision of the hybrid filtering-based system for the quadrotor drone. The performance metrics are summarized in the table below.

Table 4: Performance Comparison of Quadrotor Drone Attitude Control Systems
Metric Proposed System (Hybrid Filtering) Traditional System (PID Only)
Yaw Angle Variance under Noise 0.0015 rad² 0.0042 rad²
Roll Angle Recovery Time 0.5 s >5 s (system failure)
Tracking RMSE (roll) 0.05° 0.15°
Overshoot Percentage 2% 15%
Disturbance Rejection Ratio 85% 40%
Response Speed (10-90% rise time) 0.1 s 0.3 s

The experimental results clearly demonstrate that the proposed anti-jamming attitude control system for the quadrotor drone outperforms traditional methods. The hybrid filtering algorithm effectively combines sensor data to provide accurate attitude estimates, while the cascade PID control ensures robust and responsive actuation. The quadrotor drone equipped with this system exhibits strong anti-jamming ability, high control accuracy, and fast response speed, making it suitable for applications in noisy and dynamic environments.

Mathematical Modeling and Analysis

To further understand the system’s behavior, a mathematical model of the quadrotor drone dynamics is presented. The quadrotor drone is modeled as a rigid body with six degrees of freedom: three translational and three rotational. The equations of motion are derived using Newton-Euler formalism. Let $\mathbf{p} = [x, y, z]^T$ denote the position in the inertial frame, and $\mathbf{\Theta} = [\phi, \theta, \psi]^T$ represent the Euler angles (roll, pitch, yaw). The rotation matrix from the body frame to the inertial frame is $R$, which is a function of $\mathbf{\Theta}$. The dynamics can be expressed as:

$$
m \ddot{\mathbf{p}} = R \mathbf{F} – m \mathbf{g}
$$

$$
I \dot{\boldsymbol{\omega}} + \boldsymbol{\omega} \times I \boldsymbol{\omega} = \boldsymbol{\tau}
$$

where $m$ is the mass of the quadrotor drone, $\mathbf{g} = [0,0,g]^T$ is gravity, $I$ is the inertia matrix, $\boldsymbol{\omega} = [p,q,r]^T$ is the angular velocity in the body frame, $\mathbf{F}$ is the total thrust force, and $\boldsymbol{\tau}$ is the torque vector. For a quadrotor drone with four motors, the thrust and torques are related to motor speeds $\Omega_i$ by:

$$
F = k_f (\Omega_1^2 + \Omega_2^2 + \Omega_3^2 + \Omega_4^2)
$$

$$
\tau_\phi = k_f l (\Omega_4^2 – \Omega_2^2)
$$

$$
\tau_\theta = k_f l (\Omega_3^2 – \Omega_1^2)
$$

$$
\tau_\psi = k_m (\Omega_1^2 – \Omega_2^2 + \Omega_3^2 – \Omega_4^2)
$$

where $k_f$ is the thrust coefficient, $k_m$ is the torque coefficient, and $l$ is the arm length. The attitude control system aims to regulate $\mathbf{\Theta}$ to desired values. The hybrid filtering algorithm estimates $\mathbf{\Theta}$ from sensor data, and the control law computes desired motor speeds. The closed-loop system stability can be analyzed using Lyapunov theory. Consider a Lyapunov candidate function $V = \frac{1}{2} e_\Theta^T e_\Theta$, where $e_\Theta = \mathbf{\Theta}_{desired} – \mathbf{\Theta}$. The derivative is:

$$
\dot{V} = e_\Theta^T \dot{e}_\Theta = – e_\Theta^T K_p e_\Theta – e_\Theta^T K_i \int e_\Theta \, dt – e_\Theta^T K_d \dot{e}_\Theta
$$

With properly tuned PID gains, $\dot{V} < 0$, ensuring asymptotic stability. The hybrid filter enhances this by providing accurate $\mathbf{\Theta}$ estimates, reducing estimation errors that could degrade stability. The filter’s frequency response can be analyzed using transfer functions. For the complementary filter, the transfer function from gyroscope and accelerometer inputs to filtered output is:

$$
H(s) = \frac{\alpha s}{s + \alpha} + \frac{1 – \alpha}{s + \alpha}
$$

This represents a low-pass filter for accelerometer data and a high-pass filter for gyroscope data, with cutoff frequency determined by $\alpha$. For the quadrotor drone, $\alpha$ is tuned to balance noise rejection and dynamic response. Typically, $\alpha = 0.98$ for a cutoff frequency around 10 Hz. The hybrid filter extends this by incorporating multiple sensors, resulting in a more robust frequency response. The overall system transfer function from disturbance to attitude error can be derived as:

$$
G_{cl}(s) = \frac{G_{dist}(s)}{1 + G_{c}(s) G_{plant}(s) H(s)}
$$

where $G_{dist}(s)$ is the disturbance transfer function, $G_{c}(s)$ is the controller transfer function (cascade PID), $G_{plant}(s)$ is the plant dynamics, and $H(s)$ is the filter transfer function. The magnitude of $G_{cl}(j\omega)$ indicates disturbance attenuation. For the proposed system, $|G_{cl}(j\omega)|$ is significantly lower at both low and high frequencies compared to the traditional system, confirming superior anti-jamming performance. This mathematical analysis underpins the experimental results and validates the design choices for the quadrotor drone.

Implementation Considerations and Future Work

Implementing the anti-jamming attitude control system for the quadrotor drone involves practical considerations such as computational load, power consumption, and environmental adaptability. The main controller must execute the hybrid filtering and control algorithms within strict timing constraints. To optimize performance, fixed-point arithmetic or hardware acceleration can be employed. Power management is crucial for extended flight times; the system includes low-power modes for idle periods. Additionally, the quadrotor drone must operate in diverse conditions, so the software incorporates adaptive tuning based on sensor health and disturbance levels. For instance, the filter coefficients $\alpha$, $\beta$, and $\gamma$ can be adjusted online using machine learning techniques to adapt to changing environments.

Future work may focus on enhancing the system with advanced features. One direction is integrating machine learning for predictive disturbance compensation, allowing the quadrotor drone to anticipate and counteract jamming signals. Another area is swarm coordination, where multiple quadrotor drones communicate to share attitude data and collectively resist disturbances. The wireless module could be upgraded to support mesh networking for robust communication. Moreover, the system could be extended to include vision-based sensors for obstacle avoidance and precise landing, further expanding the quadrotor drone’s capabilities. Research into novel filter designs, such as Kalman filters with adaptive noise covariance, could also improve attitude estimation accuracy.

The proposed system has broad applications in fields such as surveillance, agriculture, delivery, and search-and-rescue. For example, in agricultural monitoring, the quadrotor drone can maintain stable flight despite wind gusts, ensuring high-quality imaging. In delivery services, precise attitude control enables safe navigation in urban environments with electromagnetic interference. The anti-jamming features are particularly valuable in military contexts where jamming signals are prevalent. By leveraging hybrid filtering and cascade control, this system provides a reliable solution for demanding quadrotor drone operations.

Conclusion

This paper presented the design and implementation of an anti-jamming attitude control system for quadrotor drones based on hybrid filtering. The system addresses the limitations of traditional methods by combining advanced hardware components and sophisticated software algorithms. The hardware design includes a redundant main controller, dual sensor modules for resilience, efficient motor drives, and reliable wireless communication. The software design employs a hybrid filtering approach to fuse sensor data, yielding accurate attitude estimates, and a cascade PID control strategy for robust disturbance rejection. Experimental results demonstrate that the system offers strong anti-jamming capability, high control accuracy, and fast response speed. The quadrotor drone equipped with this system maintains stability under significant disturbances, outperforming conventional systems. Mathematical analysis supports the design, showing improved frequency response and stability margins. Future work may explore adaptive tuning and swarm integration to further enhance performance. Overall, this system contributes to the advancement of quadrotor drone technology, enabling reliable operation in challenging and interference-prone environments.

Scroll to Top