This shows you the differences between two versions of the page.
|
pm:prj2026:jan.vaduva:sconstantin2203 [2026/05/18 18:23] sconstantin2203 [Hardware Design] |
pm:prj2026:jan.vaduva:sconstantin2203 [2026/05/24 02:43] (current) sconstantin2203 [Rezultate Obţinute] |
||
|---|---|---|---|
| Line 6: | Line 6: | ||
| ===== Descriere generală ===== | ===== Descriere generală ===== | ||
| - | The drone's flight controller functions are executed by a ESP32 C6 super-mini paired with an MPU6050 Inertial Measuring Unit, which provides the raw data necessary for stabilization. To determine the drone’s precise orientation, a complementary filter is used and it blends high-frequency gyroscope data with stable accelerometer readings to achieve a balance between short-term accuracy and long-term stability. This orientation data feeds into a continuous control loop where a Proportional-Integral-Derivative (PID) controller calculates the required throttle adjustments based on the error between the desired and actual state, with these commands then being transmitted to the motors as Pulse Width Modulation (PWM) signals. Instead of a traditional radio transmitter, the drone is managed via a dedicated web interface stored in the microcontroller's flash memory and accessed through a local area network, providing a streamlined, browser-based control platform for the operator. The physical frame is made of 4 3d printed arms attached to a 3mm | + | The drone's flight controller functions are executed by a ESP32 C6 super-mini paired with an MPU6500 Inertial Measuring Unit, which provides the raw data necessary for stabilization. To determine the drone’s precise orientation, a complementary filter is used and it blends high-frequency gyroscope data with stable accelerometer readings to achieve a balance between short-term accuracy and long-term stability. This orientation data feeds into a continuous control loop where a Proportional-Integral-Derivative (PID) controller calculates the required throttle adjustments based on the error between the desired and actual state, with these commands then being transmitted to the motors as Pulse Width Modulation (PWM) signals. Instead of a traditional radio transmitter, the drone is managed via a dedicated web interface stored in the microcontroller's flash memory and accessed through a local area network, providing a streamlined, browser-based control platform for the operator. The physical frame is made of 4 3d printed arms attached to a 3mm |
| polycarbonate sheet. | polycarbonate sheet. | ||
| Line 16: | Line 16: | ||
| ^ Component ^ Quantity ^ | ^ Component ^ Quantity ^ | ||
| | ESP32-C6-Super-Mini | 1 | | | ESP32-C6-Super-Mini | 1 | | ||
| - | | MPU6050 (IMU) | 1 | | + | | MPU6500 (IMU) | 1 | |
| | A2208 1400KV 14T BLDC Motor | 4 | | | A2208 1400KV 14T BLDC Motor | 4 | | ||
| | 30A ESC | 4 | | | 30A ESC | 4 | | ||
| Line 32: | Line 32: | ||
| BMS: The battery management system is needed to have a safe battery pack so they charge uniformly and don't overdeplete. | BMS: The battery management system is needed to have a safe battery pack so they charge uniformly and don't overdeplete. | ||
| + | |||
| + | {{:pm:prj2026:jan.vaduva:drone_top.jpeg?350|}}{{:pm:prj2026:jan.vaduva:drone_side.jpeg?350|}} | ||
| + | {{:pm:prj2026:jan.vaduva:drone_proof.jpeg?700|}} | ||
| + | |||
| ===== Circuit Diagram ===== | ===== Circuit Diagram ===== | ||
| {{:pm:prj2026:jan.vaduva:const_sebastian_schema_electrica.png?800|}} | {{:pm:prj2026:jan.vaduva:const_sebastian_schema_electrica.png?800|}} | ||
| + | ===== Software Design ===== | ||
| - | ESP32-c6-super-mini: Almost all the pins on the microcontroller can do the same things (PWM, SPI), so I chose them in the most convenient way possible for the circuit layout on the breadboard. I chose pins 4, 5, 6, 7 for SPI, leaving them to be defined in the software as SCLK, MOSI, MISO, and CS. The pins chosen for the motors must be capable of PWM, and since all pins on the microcontroller are capable of producing a PWM signal, I chose pins 20, 19, 18, 15 for the 4 motors. | + | Up until now I've implemented a driver for the SPI data transfer of the accelerometer and gyroscope data from the MPU6500. That data would be further processed by multiplying it by the scalar for the chosen resolution. The scaled data would further be polled at a bigger frequency than the control loop, counting how many readings would happen between each loop and then dividing the summed data by that number, achieving an oversampling effect to remove noise from the data. A lowpass filter would be applied over both accelerometer and gyroscope data to remove the low frequency noise create by mechanical movements. What remains is clean data that is fused into a single attitude measurement with a complementary filter. At startup, the sensor goes through a calibration process in which the average of multiple stationary readings is taken and saved as a stationary error which is later subtracted from each reading. |
| - | MPU6500: This IMU is compatible with both I2C and SPI, but I chose SPI due to its higher speed. For SPI, the following pins are used: SCLK, SDI, SDO, NCS. | + | UAVs should handle unpredictable disruptions, the most unpredictable of which can be the pilot so I wrote a function to interpolate the current throttle to the desired throttle to soften quick changes made by the pilot. Controlling the drone is easy; the remote is made of a direction knob which tilts the drone in the desired direction and a throttle knob which tells the motors how fast they should spin. The remote is a web interface served by the microcontroller if the browser is connected to the microcontroller's local network. Websockets transmit the data from the remote to the microcontroller. |
| - | Power Distribution Board: This module is connected to the drone's battery and distributes power to the ESCs and the microcontroller. I connected the 5V terminals to the power pins of the ESP and the motor power terminals to the ESCs. | + | The attitude measurement is used to compute the input for the PID controller. The input for the controller is the error given by the difference in the attitude of the UAV and the desired attitude which is set by the pilot. The flow of the program is based on a 30ms period flow of inputs from the remote, a 250Hz control loop, and the program loop in which they are processed and used. As a safety measure, a neutral attitude and a low throttle is set if there have been more than 35ms from the last input, being activated by a watchdog timer. Absence of input data isn't the only feature using a timer; the control loop, being as important as it is, is entered via a flag set by an interrupt triggered when 4000 microseconds pass. |
| - | ESC: I connected their signal to the PWM pins of the microcontroller, and they are powered by the power distribution board. | + | Motor mixing is done after all the PID calculations are done, resulting in the motor output which is based on the frequency at which the control loop operates. The motor output is delivered via PWM with the ESP32 LED Control functionality. |
| - | ===== Software Design ===== | + | |
| - | <note tip> | + | The libraries I used for this project are the following:\\ |
| - | </note> | + | -Arduino.h - I used it for generic functions and to keep the code simple as I wanted to avoid the RTOS of the ESP32\\ |
| + | -SPI.h - the sensor readings are done using this library, I used it for simplicity and ease of use\\ | ||
| + | -WiFi.h - used for the WiFi stack necessary for the web remote\\ | ||
| + | -ESPAsyncWebServer.h - used to host the web remote interface\\ | ||
| + | -ESPmDNS.h - used to define a text address for the web remote so I wouldn't have to type the ip of the ESP32 each time\\ | ||
| + | The structure of the project: \\ | ||
| + | -main.cpp - web server functionalities, control loop \\ | ||
| + | -PID.cpp - separate PID class and functionalities \\ | ||
| + | --PID.h \\ | ||
| + | -MPU6500.cpp - separate sensor SPI readings from the main code\\ | ||
| + | --MPU6500.h | ||
| ===== Rezultate Obţinute ===== | ===== Rezultate Obţinute ===== | ||
| - | <note tip> | + | Video demonstrativ: https://www.youtube.com/watch?v=J08_xca9AOc |
| - | Care au fost rezultatele obţinute în urma realizării proiectului vostru. | + | |
| - | </note> | + | |
| ===== Concluzii ===== | ===== Concluzii ===== | ||