Manless Aerial Device
This is an Arduino library to build ESP32 / ESP32-S3 / RP2350 / RP2040 / STM32 flight controllers. A functional DIY flight controller can be build for under $10 from readily available development boards and sensor breakout boards. Ideal if you want to try out new flight control concepts, without first having to setup a build environment and without having to read through thousands lines of code to find the spot where you want to change something.
Quadcopter.ino
is a 1000 line demo program for a quadcopter. It has been flight tested on ESP32, ESP32-S3, RP2350, RP2040, and STM32F405 microcontrollers with the Arduino IDE. The program can be easily adapted to control your plane or VTOL craft. The source code has extensive documentation explaning what the settings and functions do.
I enjoy hacking with electronics and I'm attempting to write some decent code for this project. If you enjoy it as well, please leave some feedback in the form of Stars, Issues, Pull Requests, or Discussions. Thanks!
- Development board:
- RP2350/RP2040 (e.g. Raspberry Pi Pico2)
- ESP32-S3/ESP32 (e.g. Espressiv ESP32-S3 DevKitC)
- STM32 (e.g. Black Pill or a commercial flight controller)
- SPI IMU sensor (BMI270, MPU9250, MPU6500, or MPU6000), if not available then use an I2C IMU sensor (MPU6050 or MPU9150)
- RC Receiver: ELRS, CRSF, SBUS, DMSX, or PPM
- BEC or DC-DC converter to power your board from a battery
- ESC (OneShot125 or 50-490Hz PWM) and/or servos (50-490Hz PWM)
- GPS Module (Serial)
- Barometer (I2C BMP280, MS5611)
- Magnetometer (I2C QMC5883L)
- Current/Voltage Sensor (ADC or I2C INA226)
- Optical Flow Sensor (I2C)
- Connect the required hardware to your controller board:
- See RP2350/RP2040 pinout and instructions
- -or- ESP32-S3/ESP32 pinout and instructions
- -or- STM32 pinout and instructions
- Connect your IMU (gyro/acceleration) sensor as shown here.
- Install the madflight library in Arduino IDE. (Menu Tools->Manage Libraries, then search for "madflight")
- Open example Quadcopter.ino in the Arduino IDE.
- If you're not using a default pinout then setup your board pinout in the CUSTOM PINS section.
- Edit the HARDWARE section to enable the connected peripherals
- Compile and upload Quadcopter.ino to your board. Connect the Serial Monitor at 115200 baud and check the messages. Type
help
to see the available CLI commands. - Use CLI print commands like
pimu
,pgyro
,proll
to Check that IMU sensor and AHRS are working correctly. - IMPORTANT: Use CLI
calimu
andcalmag
to calibate the sensors. - Connect radio receiver to your development board according to the configured pins.
- Edit the RC RECEIVER section. Either match you RC equipment to the settings, or change the settings to match your RC equipment.
- Check your radio setup: Use CLI
ppwm
andpradio
to show pwm and scaled radio values. - Connect motors (no props) and battery and check that motor outputs are working correctly. For debugging, use CLI
pmot
to show motor output. - Mount props, go to an wide open space, and FLY!FLY!
By default madflight has these safety features enabled:
- Motors only rotate when armed.
- Arming Procedure: set throttle low then flip the arm switch from disarmed to armed.
- Kill Switch: when the arm switch is in the disarm position, disarm and stop motors until re-armed.
- Failsafe: when radio connection is lost, disarm and stop motors until re-armed.
- Armed Low Throttle: motors run at low speed, to give visible armed indication.
- LED armed/disarmed indicator.
- Keep it simple!!!
- Based on dRehmFlight
- Coded primarily for readability, then for speed and code size.
- No external dependencies, all modules are included in the
src/madflight
directory. - The madflight flight controller runs standard
setup()
andloop()
. - It mainly uses plain Arduino functionality: Serial, Wire, and SPI. One custom hardware dependent library is used for PWM. Therefor, it can fairly easily ported to other 32 bit microcontrollers that support the Arduino framework. Also porting to other build environments like PlatformIO or CMake should not be a huge effort.
- The following modules are used:
imu
Inertial Measurement Unit, retrieves accelerometer, gyroscope, and magnetometer sensor dataahrs
Attitude Heading Reference System, estimates roll, yaw, pitchrcin
RC INput, retrieves RC receiver datacontrol
PID controller and output mixerout
Output to motors and servosmag
Magnetometer (external)baro
Barometergps
GPS receiverbb
Black Box data loggercli
Command Line Interface for debugging, configuration and calibrationcfg
Read and save configuration to flashhw
Hardware specific code for STM32, RP2040 and ESP32
- Most modules are interfaced through a global object, for example the
imu
object has propertyimu.gx
which is the current gyro x-axis rate in degrees per second for the selected IMU chip. - For a quick overview of the objects, see header
src/madflight/interfaces.h
which defines the module interfaces. - The module implementations are in subdirectories of the
src/madflight
directory. Here you find the module header file, e.g.src/madflight/imu/imu.h
. In theextras
directory your find test programs for the modules, e.g.extras/TestMadflight/imu.ino
. - The module files are usually header only, that is, the header also includes the implemention.
This code is a shared, open source flight controller for small micro aerial vehicles and is intended to be modified to suit your needs. It is NOT intended to be used on manned vehicles. I do not claim any responsibility for any damage or injury that may be inflicted as a result of the use of this code. Use and modify at your own risk. More specifically put:
THIS SOFTWARE IS PROVIDED BY THE CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
Logo image copyright (c) 1975 Deutsches MAD Magazine. This project is not associated with MAD Magazine.