S14: Quadcopter

From Embedded Systems Learning Academy
Revision as of 08:04, 21 May 2014 by Proj user12 (talk | contribs) (Frame)

Jump to: navigation, search

Grading Criteria

  • How well is Software & Hardware Design described?
  • How well can this report be used to reproduce this project?
  • Code Quality
  • Overall Report Quality:
    • Software Block Diagrams
    • Hardware Block Diagrams
      Schematic Quality
    • Quality of technical challenges and solutions adopted.

Quadcopter

Abstract

Applications for smaller Unmanned Aerial Vehicle (UAV) have significantly increased in recent decades. Quadcopter is one of the most successful vertical take-off and landing vehicle with autonomous flight control and stable hovering capabilities. These prominent features have led to a rise in Quadcopter research in universities as well as industries. Quadcopter project engages people from Electrical, Mechanical and Computer science background with knowledge on various concepts like Control systems, Real-Time Embedded Systems, Robotics and Navigation. This web-page provides you detailed information on the mechanics of Quadcopter, Concepts of Flight control along with programming and testing for stable flight.

A Quadcopter (Quad-rotor helicopter) is a multi-rotor aerial vehicle that is lifted and propelled by four rotors. The thrust generated by the propellers lifts the Quadcopter while the flight controller system govern the rotor speed for attitude control. A wireless remote control is used to interact with the flight controller system for changing the flight path. We begin by explain the basics of Quadcopter mechanics, then sections explaining the mechanical design approach, algorithms and parameters used for stable flight control, and lastly the testing and tuning mechanism.

Objective and Scope

Our objective is to assemble the Quadcopter, then design and build a flight controller system that stabilizes the flight and accept commands from a hobbyist remote control during its flight.

The scope of our project can be divided into three parts:

  • Design and build interfaces to all the on-board electronic sensor such as IMU, barometer and distance sensors
  • Design and build interfaces to telemetry and radio modules to communicate with remote control and the computer
  • Process the various sensor inputs and control the brushless motors on board using an electronic speed control system to stabilize the Quadcopter

Team Members & Responsibilities

  1. Sree Harsha
    • PWM Design, Remote Control Input, Quadcopter assembly
  2. Balaji
    • Sensor Data Processing, Quadcopter Assembly
  3. Divya Kamath
    • Flight Controller Design, Code Integration

Introduction

Basics


File:Propeller direction2.JPG
Fig 2. Propeller rotating direction

Quadcopter is one of the successful aerial vehicles which support vertical take-off and landing.It has 4 rotors - 2 run clockwise(CW) and 2 counter-clockwise(CCW). This is to cancel out the torque generated by a set of rotors running in any one direction.

File:Quad config.JPG
Fig 1. Quadcopter Orientation

There are two types of orientation for a quadcopter : + configuration and X configuration. Our design is an X configuration as it allows unblocked front view for mounting a camera. The quadcopter motion in the 3 axis is known as Pitch, Roll and Yaw.

Pitch is the ascending or descending motion. Roll is tilting towards the left or right. Yaw is rotating left or right.

File:RPY.JPG
Fig 3. Pitch, Roll and Yaw movement


File:Quad motion1.JPG
Fig 5. Quadcopter motion in different axis

Quadcopter Modes


Most commercially available quadcopters work in one of two possible modes:

  1. Aerobatic Mode: This mode allows you to perform spins and flips on the quadcopter. The accelerometer is not necessary in this case.
  2. Attitute/Stable Mode: This is the preferred mode for beginners and this is the mode our quadcopter will run in. In this mode, data from accelerometer and gyro sensor is combined to calculate the quadcopter angle. Once the remote control stick is moved to non-idle location, the quadcopter angle is changed accordingly and held at the angle. Unlike the aerobatic mode, no spins or flips will be performed.

Arming/Disarming the Quadcopter


File:Arm disarm1.JPG
Fig 4. RC Arm Disarm

We need to take certain safety precautions for every quad-copter. We don't want the quad-copter to accidentally arm while being transported or not in use and similarly we don't want it to disarm when flying. Arming a quad-copter indicates that when throttle is raised, the motors will begin to spin and disarming a quad-copter indicates that motors won't spin.

On most commercially available quad-copters, arming is done with a full-right yaw and no throttle, while disarming is done with a full-left yaw and no throttle. The positions can be swapped as per user preference.



Schedule

Sl. No Start Date End Date Task Status Actual Completion Date
1 2/28 2/28 Order Components and Make a schedule Component Ordering Partially Completed (critical components done), Motors pending. (Update 4/14 - All components ordered) 3/7/2014
2 3/1 3/30 Components Procurement. Motors arrived but don't fit into the frame. Got motor mounts from Century Heli shop, drilled holes to fit the motors, backup IMU arrived.(Update 4/14 - All components ordered) 3/21/2014.
3 2/20 3/15 Establish communication with all sensors and validate data IMU done. 3/14/2014
4 2/28 3/5 Establish communication with radio module of remote control Coding complete. Testing in progress with Radio remote and receiver.(Update 4/21 - Remote Control Communication Successful 4/19
5 2/28 3/5 Speed control of motors Flashed SimonKK firmware to ESC. One of the ESC went kaput and 2 others have problem running at slower speeds. Tested with another set and motors work fine. Ordered Afro ESC with pre SimonKK firmware flashed. Another frame, radio and few other components ordered as backup. 3/29/2014
6 2/28 3/25 Flight Controller Algorithm (PID Controller) Coding. Playing with the coefficients.
  1. Update 4/14 - Coding Completed, testing pending.
  2. Update 4/21 - Testing In progress.
  3. Update 4/25 - Initial testing shows motor speed responding well to sensor values and remote
4/25
7 3/15 3/30 Create tasks and integrate complete code In progress
  1. Update 4/14 - PID completed, Flight Controller tasks completed. Device driver for RC input ready. Pending - PWM (motors), Math calculation for motor speed from Raw RC data and sensor angles, UART communication and parser for IMU data
  2. Update 4/21 - UART communication and parser completed. Facing issue with >16 characters, RC input completed.
  3. Update 4/22 - Code to convert RC input from PWM to angle (radian) completed. PWM code for motors done.
  4. Update 4/24 - Initial Code Completed.
4/23/2014
8 4/10 4/10 Assemble quadcopter Complete. Initial flight test with reference flight controller shows jitters with radio PWM input. Magnetometer goes crazy because of motor magnetic field. Control system and sensors will now be placed on an elevated platform. 3/29/2014
9 4/10 4/18 Initial testing and tweaks In progress

Update 4/25 - Initial testing on ground shows that motor speed for corresponding change in sensor and RC is as expected. Next step is to connect to the motors and see how the quad behaves.

4/25
10 4/15 - End Final Testing Started 4/25

Update 4/28

  1. Enabled ZigBee Telemetry which helps us remotely debug the quadcopter (Uart2)
  2. Connected the motors and speed seems to vary with remote control input. Propellers were disconnected during this testing

Update 5/8

  1. All electronics is mounted on the frame
  2. Basic hover seems to be working but fine tuning needed
  3. Motor Calibration has been introduced

Update 5/9

  1. Attempting to introduce Remote Tuning using 8 channel RC

Update 5/10

  1. Remote control tuning introduced using Gear, Aux1, Aux2 channels - Roll tuning in progress

Update 5/16

  1. Initial flight test was a disaster. The quad took off but was spinning around yaw axis and went out of control. It crashed on hard surface and shattered the landing gear and battery. Electronics, motors and frame intact. Switching to backup quadcopter. Thorough code review with revamped PID tuning in progress....
- Testing in progress

Parts List & Cost

Qty Description Manufacturer Part Number Total Cost
4 Afro ESC 20Amp Multi-rotor Motor Speed Controller (SimonK Firmware) Afro ESC 9192000131-0 $50.00
4 Turnigy Multistar 4822-690Kv 22Pole Multi-Rotor Outrunner Turnigy 9392000004 $129.80
1 Inertial measurement unit (IMU) MPU-9150 Sparkfun SEN-11486 $40.00
1 SJOne Board Preet LPC1758 SJSU CmpE Board $80.00
1 Turnigy 9X 9Ch Transmitter w/ Module & 8ch Receiver (Mode 2) (v2 Firmware) Turnigy TX-9X-M2 $69.97
1 Turnigy nano-tech 6000mah 4S 25~50C Lipo Pack Turnigy N6000.4S.25 $55.75
1 AQ-600 Carbon Fiber Quadcopter Frame 550mm HobbyKing 047000006 $93.27
2 10x4.5MR, 10x4.5MRP Propellers, Prop Adapter Ring Set APC $26.94
1 Hobbyking Multi-Rotor Power Distribution Board HobbyKing 9171000180 $2.20
Accessories(Wires, bolt+nut, foamboard, prototype board, glue, zip tags, double sided tape, insulation tape) $50.00
Total Cost (excluding backup parts, shipping and taxes) $597.93

Backup Parts & cost

Qty Description Manufacturer Part Number Total Cost
1 Turnigy 5600mAh 4S 14.8V 60C Hardcase Pack (Removable Leads) Turnigy $59.79
1 Invensence 9150 IMU Breakout board ebay $17.00
4 Electronic Speed Controller (ESC) Turnigy Plush 25 Borrowed
1 DX6i 6 Channel 2.4Ghz Tx/Rx Remote Control Spektrum DX6i Borrowed
1 Quadcopter frame HJ MWC $21.26
1 Motor mounts Century Heli $25.94
1 Afro ESC 20Amp Multi-rotor Motor Speed Controller (SimonK Firmware) Afro ESC 9192000131-0 $12.49
1 Turnigy Multistar 4822-690Kv 22Pole Multi-Rotor Outrunner Turnigy 9392000004 $32.45
Total Cost (excluding shipping and taxes) $169.11

Design & Implementation

System Design


File:System design2.JPG
Fig 6. System Design Diagram

MPU9150 (sensor board) and the RC receiver are the primary inputs to the system. The sensor board measures the real-time orientation of the platform and transmits the data to the main controller board using UART serial protocol. The SJOne board receives the data from the sensor board and compares it with the data received from the RC receiver. The values are scaled down to the same range and then compared to obtain the difference. This difference is termed as error.

Depending on the magnitude of the error, appropriate corrective coefficients are chosen by the PID loop and the correction is sent to the actuator command sub system to be integrated into the motor commands. These corrections change the orientation of the platform and therefore reduce the error in orientation of the platform. The closed loop feedback system as described above ensures stability of the aerial platform.

File:Mpu9150.JPG
Fig 7. MPU-9150 breakout board


Hardware


MPU-9150


The MPU-9150 consists of a 3-axis accelerometer, 3axis Gyroscope and a 3 axis magnetometer. its a one chip IMU solution with onboard Motion processor for sensor fusion.Though it inherently supports on board Sensor Fusion, the IP is undisclosed. Therefore we used the library for arduino by Pansenti. (https://github.com/Pansenti) The 6 axis sensor fusion (accel+gyro) is done on the MPU and sent to an arduino where the magnetometer data is used for YAW correction. The arduino transmits the orientation data over UART which is recieved by the SJONE for further processing. To check its working condition, we used the modified Razor-IMU GUI written in python. The code parses the serial data from the IMU and displays the orientation in real-time using Vpython.(video and code to be linked).

Remote Control Transmitter and Receiver


File:Rc.JPG
Fig 8. Remote Control
File:Receiver1.JPG
Fig 9. Receiver module

We are using 8 channel remote control to maneuver the quadcopter. The channels used are as below:

  1. Roll/Aileron - Controls the aircraft's right/left movement
  2. Pitch/Elevation - Moves the copter front/back
  3. Throttle - Increases the thrust output of the motors. This controls the height at which the Quadcopter should fly.
  4. Yaw/Rudder - Causes movement about the vertical axis. This changes the direction in which the aircraft is pointing.
  5. Gear - Used as a on/off switch for tuning the Gain values of PID loop. When 'ON', the AUX1 and AUX2 values from the remote are loaded to 2 of the gain values.
  6. Channel 6 - Not used
  7. AUX1 - Used to control P gain co-efficient for any one of the 3 axis.
  8. AUX2 - Used to control I/D gain co-efficient in sync with the AUX1 channel axis.


Brushless Motors


File:Motors.jpg
Fig 11. Brushless DC Motors

Brushless motors spin at higher speeds and consumer less power than the DC motors. Its energy efficient as it doesn’t lose much energy like the DC motors. The kv rating on the motor indicates how many RPM the motor can rotate for a given number of volts. It comes with various accessories to ensure that the propeller locks onto the shaft without causing any slip.

The motors (Turnigy Multistar outrunners) used for this project have a higher power system. Each motor has 22 poles, high quality parts, precision balanced for smooth running and is designed for maximising Multi-rotor performance.

File:Esc.JPG
Fig 10. Electronic Speed Controller

Electronic Speed Controllers


The brushless motors are normally 3 phased, so direct supply of DC power will not turn the motors. The Electronic Speed Controllers (ESC) comes are interfaced to the motors which generating three high frequency signals with different but controllable phases continually which helps the motors to spin. The PWM signal generated by the microcontroller is fed to the ESC, which in turn provide signal to motor operation. It is recommended to that the ESC rating is atleast twice than the motor current rating to avoid any mishap.

The AFRO ESC used for this project comes with jitter-free hardware PWM input, high efficiency and smooth power response. The ESCs come with multi-rotor specific SimonK firmware preloaded, which is specifically designed for multi-rotor aerial platforms.

File:Fc.JPG
Fig 13. Flight Controller - SJOne Board

Flight Controller

File:Frame.JPG
Fig 12. Quadcopter Frame

SJOne Board is programmed to behave as the Flight controller, acting like the brain for controlling the Quadcopter. This microcontroller continuously receives data from the sensor and remote control and performs calculations to make adjustments to each motor thereby keeping the Quadcopter level. The calculations are run few hundred times a second in order to keep the Quadcopter perfectly balanced. Auxiliary microcontroller is used to just send the sensor data to the main board via UART protocol.

Frame


Frame is the structure which houses all the components together. It comes in different shapes and material. The frame material should be rigid enough to absorb vibration from motors, which in turn reduces the noise in the sensors. Carbon Fiber is the most rigid and vibration absorbent but expensive. It is still the best when considering long term benefits. Aluminium is lighter but is prone to vibrations coming from the motor and causes noise in the sensors. Wood absorbs vibrations better but is not rigid enough to survive a high impact crash.

Battery pack is the power source for the Quadcopter. Lithium Polymer (LiPo) battery is preferred because it is light and its current ratings meet the motor power requirements well. Nickel Metal Hydride (NiMH) is also preferred as they are cheaper, but a lot heavier than LiPo Battery.

Hardware Interface


File:Connections1.JPG
Fig 14. SJ-One Board Pin connections
File:Connections3.JPG
Fig 15. Hardware Components Interface

Design Consideration

  1. UART communication protocol for reading sensor data and telemetry
  2. Pulse Width Modulation(PWM) signal generation for motor control
  3. GPIO Interrupts to decode PWM signals from Remote Control channels


Pin Connections


Sl. No Port and Pin Number Pin Type Purpose
1 P0.0 and P0.1 UART 3 IMU Communication (Arduino)
2 P2.4, P2.5, P2.6, P2.7, P0.26, P0.29, P0.30 GPIO Input Remote Control Receiver Input
3 P2.0, P2.1, P2. 2, P2.3 PWM PWM output to motors
4 P2.8, P2.9 UART2 ZigBee telemetry




/

Software Architecture


File:Sw arch.JPG
Fig 7. MPU-9150 breakout board

The software framework adopted for this project is sequential. Even though multiple tasks are involved, the microprocessor used in the system is single core and therefore all tasks are executed sequentially. Running multiple parallel tasks in a sequential processor results in time-slicing which is not desirable in a real-time system. Therefore all executions are programmed to be serial and interrupts are used to switch context to independent high critical tasks when required.

Object oriented programming concepts (OOPS) are employed to ensure code modularity. C++ is a high level general purpose compiled programming language which supports both high level and low level features. The software is completely coded in C++ utilizing OOPS concepts to ensure readability and efficiency.

Real-time operating systems (RTOS) play a vital role in ensuring synchronization with multiple processes while maintaining hard deadlines for execution of each process. FreeRTOS is a free open-source microkernel real-time operating system developed for embedded applications. FreeRTOS is used in this project to ensure synchronization between the various tasks under execution. The operating system runs on the main microcontroller on SJOne board and schedules processes (known as tasks in FreeRTOS) based on priority and resource requirement.

PID Controller



For our flight controller algorithm, we are using a PID controller. PID (proportional, integral, derivative) controller is a feedback control system which attempts to minimize the error in the output using three constant values: P, I and D i.e. the proportional, integral and derivative values.

Converting Remote Control Data to Motor Speed

The following steps are involved in converting raw RC (remote control) data to motor speed

  1. Get the RC data. Usually a PWM signal
  2. Scale up/down this value using a pre-decided curve. (Linear/Exponential)
  3. Convert this value into angles.
  4. Apply PID on Roll/Pitch/Yaw RC command (Using the angles calculated by IMU (Inertial Measurement Unit) as the PID input and angles calculated from the previous step as the desired setpoint)
  5. Use these angles to adjust motor speeds and direction (Add/Subract to Throttle Command)

Implementation


Overall System Algorithm

  1. Initialize the system and check for any errors. If found, display on the board LED and do not arm the system.
  2. If no errors, arm the system and wait for user input.
  3. Update the sensor values to the variables assigned. Update the remote control channel values to the variables assigned.
  4. Constantly run the PID calculation loop on sensor values and user input and generate the PID output in terms of throttle on the motors.
  5. Decode this throttle value and assign the run duty cycle in the form of PWM signal to each of the motors. Goto step 3.

Remote Control Signal Processing

  1. Initialize every channel input interrupt. Set all delta variables to zero.
  2. When an interrupt occurs on rising edge, note the system time and store it as rise time.
  3. When an interrupt occurs on falling edge, note the system time and store it as falling time.
  4. Calculate the difference between the two times which gives the delta value.
  5. Store this in the remote control channel variable and reset the delta value to zero. Goto step 2.

Mechanical Design

Testing & Technical Challenges

Getting a quadcopter to fly smoothly isn't a smooth process at all. But failures do have teach us a lot. Listed below are some of the issues we faced during the course of this project.

Quadcopter Assembly

  1. Unexpected Throttle: Throttle seems to shoot to maximum without command. Solution - Order new remote control (:O)
  2. Bricked ESC: Tried flashing SimonK Firmware into ESC for faster update rate. ESC didnt respond! Solution - Buy a whole new set ESCs (!)
  3. Propeller Issue: Didnt check propeller specs before ordering. Had to return.
  4. Specifications were not clear for the products ordered online: Motors were too big for the frame. Different countries follow different metrics. Need to be careful while assembling parts ordered from different websites.
  5. Magnetic Interference on Compass:Motors create really intense magnetic fields which interferes with the magnetometers magnetic field. As a result magnetometer readings are affected. Magnetometer needs to be kept at an elevation to avoid this.

Quadcopter Software

  1. UART FIFO: If messages longer than 16 bytes is transmitted over UART, then all characters exceeding 16 bytes are lost. This issue is yet to be resolved. Looking into it.
    1. (4/23)Resolved this by using Interrupts and queues. The polling method created a time delay causing some data to be lost.
  2. Rear Right motor was always high and not responding to any input. The issue was that while computing PID we must be measuring the change in value from the center value, but instead we were measuring change from the minimum value.
  3. Uint to int: A lot of calculation needed the use of integer but we were using unsigned integer types. Hence values were not right.
  4. Pitch vs motor speed: Change in pitch was causing an opposite change in motor speed. We interchanged the signs for the front and rear motors and resolved this issue.
  5. IMU Disconnected: Quadcopter goes crazy if the IMU is not connected. Junk values are updated as PID and quadcopter flies away ramming to ceilings! Fixed this terrible bug by introducing a check to see if IMU is connected, if not flight controller loop is not run.
  6. Motor PWM Percentage: PWM percentage was not calculated based on motor frequency. Fixed this by introducing a formula dependent on motor frequency.
  7. RC Limits: RC limits are different for arming/disarming and for proper working. We were using the same limits and as a result accidental arm/disarm took place.
  8. Gain co-efficients: Changed from int to float.
  9. Motors jerk effect: Motors stalled for a fraction of a second and lost control. Initialization of angles every iteration in IMU data parsing was commented and the effect vanished.
  10. PID loop: Additional changes for P,I and D terms incorporated as per Multiwii 2.1 code.

Future Enhancement

Future enhancements are to include GPS capabilities and incorporate autonomous take-off and landing capabilities based on GPS co-ordinates between two places.

Conclusion

This project helped us to understand the mechanical, electrical and control system configuration that goes into building and flying a Quadcopter (we now understand the phrase "its not rocket science"!!!!!). We understood the PID control mechanism using which the Quadcopter tries to stabilize itself for a smoother flight. This project helped us to gain a lot of practical knowledge about how a system needs to be planned, designed, integrated and tested. It helped us to realize that backup plan is required no matter how organized and foolproof the original planning is followed. It is very much required to do an initial investigation on the Quadcopter parts as it would save a lot of time, effort and money once started. Every stage impacts the previous stage and future stages. If any of the stages goes kaput, it obliterates all the effort spent and we have to start from the beginning. The assembly and programing is half the effort. An equal effort will need to be spent on tuning the Quadcopter without which all the effort goes into vain in case of crash landing.


Project Video

Upload a video of your project and post the link here.

Project Source Code

Send me your zipped source code and I will upload this to SourceForge and link it for you.

References

Acknowledgement

Any acknowledgement that you may wish to provide can be included here.

References Used

  1. https://github.com/Pansenti
  2. https://code.google.com/p/sf9domahrs/
  3. http://www.rcgroups.com/forums/showthread.php?t=1284741
  4. http://blog.oscarliang.net/quadcopter-pid-explained-tuning/
  5. http://aeroquad.com/showthread.php?1167-Stable-Mode-Explained
  6. http://www.ece.ucdavis.edu/~spencer/195/datasheets/PID-Without-a-PhD.pdf
  7. http://support.motioneng.com/downloads-notes/tuning/pid_overshoot.htm
  8. http://www.instructables.com/id/RC-Quadrotor-Helicopter/?ALLSTEPS
  9. http://www.modelflight.com.au/blog/how-to-fly-remote-control-quadcopter/
  10. http://www.thorlabs.com/tutorials.cfm?tabID=33653
  11. http://www.hobbyking.com/hobbyking/store/index.asp
  12. https://www.sparkfun.com/
  13. http://aeroquad.com/forum.php

Appendix

You can list the references you used.