Flight Control and Hardware Design of Multi-Rotor Systems
Flight Control and Hardware Design of Multi-Rotor Systems
MULTI-ROTOR SYSTEMS
by
W
IE
EV
Milwaukee, Wisconsin
August 2016
Pro Q ue st Num b e r: 10141216
W
IE
EV
Pro Q ue st 10141216
Pub lishe d b y Pro Q ue st LLC (2016). Co p yrig ht o f the Disse rta tio n is he ld b y the Autho r.
This wo rk is p ro te c te d a g a inst una utho rize d c o p ying und e r Title 17, Unite d Sta te s Co d e
Mic ro fo rm Ed itio n © Pro Q ue st LLC.
Pro Q ue st LLC.
789 Ea st Eise nho we r Pa rkwa y
P.O . Bo x 1346
Ann Arb o r, MI 48106 - 1346
ABSTRACT
W
Firstly, the thesis starts by developing a reference frame and a mathematical
model for the quadcotper system. Next, flight orientation estimation is
determined through an assortment of MEMS sensors such as an accelerometer,
IE
gyroscope, and magnetometer. Each sensor will be individually addressed as to
its strengths and weaknesses with regards to orientation estimation. An
algorithm will then be proposed for the data fusion of these various sensors. This
fused data will then be fed into a control system that will efficiently stabilize the
EV
quadcopter.
Finally, this thesis will overview methods of integrating lidar data directly into
the quadcopter’s control system. Real-world lidar data is used and a
computational geometry algorithm, ICL, is employed to translate the point cloud
PR
ACKNOWLEDGEMENTS
W
as assistance in developing the RF controller. Finally, I would like to thank my
fellow lab mates, Milad Ghorbani and Wenkai Guan, who managed to put up
with the noise this thesis generated as well provide useful feedback and support.
IE
EV
PR
iii
TABLE OF CONTENTS
ABSTRACT . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . i
ACKNOWLEDGEMENTS . . . . . . . . . . . . . . . . . . . . . . . . . ii
TABLE OF CONTENTS . . . . . . . . . . . . . . . . . . . . . . . . . . iii
LIST OF TABLES . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . vii
LIST OF FIGURES . . . . . . . . . . . . . . . . . . . . . . . . . . . . . viii
CHAPTER 1 Problem Statement, Objective and Contributions . 1
1.1 Problem statement . . . . . . . . . . . . . . . . . . . . . . . . . . . 1
1.2 Objectives . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
1.3 Previous Work . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2
W
1.4 Contributions . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3
1.5 Thesis Organization . . . . . . . . . . . . . . . . . . . . . . . . . . . 4
IE
CHAPTER 2 Quadcopter Background Information . . . . . . . . . 6
2.1 Common Quadcopter Motor Types . . . . . . . . . . . . . . . . . . 7
EV
W
4.5 Sensor Fusion . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 37
4.5.1 Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 37
IE
4.6 Orientation Estimation Conclusion . . . . . . . . . . . . . . . . . . 40
CHAPTER 5 Control System Implementation . . . . . . . . . . . . 42
EV
5.1 Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 42
5.2 PID Basics . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 42
5.3 PID Software Implementation . . . . . . . . . . . . . . . . . . . . . 44
PR
W
8.4 Iterative Closest Line . . . . . . . . . . . . . . . . . . . . . . . . . . 81
8.5 Lidar Integration with Quadcopter Control System . . . . . . . . . 84
IE
8.6 Control System Testing, Simulation and Conclusion . . . . . . . . . 85
CHAPTER 9 Conclusion and Future Work . . . . . . . . . . . . . . 87
EV
REFERENCES . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 91
APPENDIX A Hardware schematics and PCBs . . . . . . . . . . . 95
A.1 Hardware Schematics . . . . . . . . . . . . . . . . . . . . . . . . . . 95
A.2 Flight Controller Schematic . . . . . . . . . . . . . . . . . . . . . . 96
A.3 Flight Controller Schematic . . . . . . . . . . . . . . . . . . . . . . 97
A.4 Flight Controller Schematic . . . . . . . . . . . . . . . . . . . . . . 98
A.5 Flight Controller Schematic . . . . . . . . . . . . . . . . . . . . . . 99
A.6 ESC Schematic . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 100
A.7 ESC Schematic . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 101
A.8 ESC Schematic . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 102
A.9 RF Controller Schematic . . . . . . . . . . . . . . . . . . . . . . . . 103
A.10 RF Controller Schematic . . . . . . . . . . . . . . . . . . . . . . . . 104
vi
W
IE
EV
PR
vii
LIST OF TABLES
W
IE
EV
PR
viii
LIST OF FIGURES
W
3.2 Mechanical dimensions of quadcopter. l represents the length of the
quadcopter and h represents the height. . . . . . . . . . . . . . . . . . 15
IE
3.3 Quadcopter free body diagram. . . . . . . . . . . . . . . . . . . . . . . 16
3.4 Grams thrust (Ti ) per duty cycle input. Duty cycle input represents
power percentage of a 3 cell lipo battery. . . . . . . . . . . . . . . . . . 17
EV
4.11 Global variation in: (a) magnetic intensity, (b) magnetic declination,
(c) magnetic inclination [11]. . . . . . . . . . . . . . . . . . . . . . . . 36
5.3
5.4
W
Code snippet of PID controller. . . . . . . . . . . . . . . . . . . . . . .
45
IE
5.5 Code snippet of pitch, roll, and yaw thrust calculations. . . . . . . . . . 46
EV
6.1 RF Marq Drone hardware: (a) Flight controller, (b) Radio controller . 50
6.3 PCB transmission lines: (a) Microstrip line, (b) Coplanar waveguide. . 55
6.6 RF Baluns: (a) Integrated Balun [13], (b) Discrete Balun [14]. . . . . 58
7.5 LiPo under voltage, over current, over charge, reverse bias, and backfeed
protection circuit. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 67
7.7 Picture of ESCs: (a) Marq ESC, (b) Marq ESC Dev board. . . . . . . 69
W
7.11 Brushless motor phase voltage (yellow) and zero cross detection com-
parator (green). . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 74
IE
8.1 Lidar plot of room . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 77
8.2 (a) Hokuyo UTM-30LX lidar used in [15] . (b) Neato XV-11 lidar device
EV
8.7 ICP and ICL integration results acting on dataset in Fig. 8.3. . . . . . 84
8.8 Quadcopter control diagram with lidar and sonar inputs added. . . . . 85
8.9 (a) Quadcopter simulation with external disturbance. (b) Plot of posi-
tional drift elimination. . . . . . . . . . . . . . . . . . . . . . . . . . . . 86
9.2 Pitch, roll, and yaw performance during hover test of quadcopter. . . . 88
xi
Acronym Definition
W
ICP: Iterative Closest Point.
Math/symbol Definition
θ Pitch
φ Roll
W
ψ Yaw
x̂ Estimate of x
IE
x̄ Unit vector of x direction
· Scalar product
EV
× Cross product
U P P ERCASE Matrix
PR
CHAPTER 1
W
coordinate system and then uses this system to determine control goals. The
remainder of the thesis focuses on how to meet the proposed control goals. An
IE
overview of existing IMU sensors is presented as well as their trade-offs with
EV
kinematics, software, and hardware involved in flight control. Finally, this thesis
vehicle (drone), designers are faced with the choice of paying for a custom
designed aerial vehicle, building their own vehicle from scratch, or sacrificing
and radios. These modules are often proprietary and have limited hardware
1.2 Objectives
fully specified, and stabilized quadcopter. This system will be specified from
W
scratch hardware and software with the intent of eliminating as many black box
future research.
Admittedly, much work has been done in the area of advance control of
multi-rotor systems and these works are too numerous for a comprehensive
reference for the development of this thesis. For example, Robert Mahony
quadcopter with state space methods [18]. Another example of advance control is
With regards to open source multi-rotor systems, Open Pilot and Clean Flight
are perhaps two of the most popular open software flight controller systems
systems, the Pixhawk and Sparky systems feature an open source flight
controllers [23],[24]. While these systems feature some open hardware and
W
In regards to indoor autonomous control, this is an active area of research for all
(ICP) algorithm [15],[25],[26]. However, in these cases the multi-rotor vehicle was
aerial vehicle by combining lidar data and IMU data with an extended Kalman
PR
filter as well as a Gaussian particle filter [27]. However, in this case the
research.
1.4 Contributions
integration than most other open source options. In addition, this thesis develops
• Provides open source software / hardware files for a remote control system
W
translation
IE
1.5 Thesis Organization
EV
associated with multi-rotor systems that will be used throughout this thesis.
PR
Chapter 3 overviews the the mathematical reference frame for the multi-rotor
system and specifies control objectives. Chapter 4 describes sensors used for
flight. This chapter also overviews the software architecture used in order to
execute the desired control system. Chapter 6 overviews the quadcopter’s radio
system and introduces applicable theory required for its design and construction.
algorithm for parsing lidar data under significant processing and memory
W
IE
EV
PR
6
CHAPTER 2
In order to provide context for future chapters, this chapter introduces the
Beyond the similarity of four propellers, there is significant design diversity. This
design diversity includes but is not limited to motor type and frame design.
W
Examples of various quad-copter implementations are shown in Fig. 2.1.
IE
EV
(a) (b)
PR
(c) (d)
Figure 2.1: Examples of quadcopter implementations [1],[2],[3],[4].
quadcopters is the motor type that they utilize. Consequently, the next section
there exist small electric motors that are light-weight, low-cost, and of simple
construction. These features make small electric motors ideal for low-cost
electric motors exist which are brushed and brushless motors. As the name
W
powered by DC, and are explained in detail in [28]. The control simplification
and cost of brushed DC motors makes them a popular choice for micro-size
IE
quadcopters such as the Turnigy Micro-X shown in Fig. 2.1(d). However, the
EV
brush which mechanically commutates the motor results in friction losses as well
as limited motor life span. Consequently, larger quadcopters often use brushless
motors are also split into two common types which are sensored and sensor-less
motors. Examples of these two motor types are illustrated in Fig. 2.2.
(a) (b)
position must be known. This can be achieved by using Hall effect sensors or by
complexity but results in heavier and more exspensive motor as seen in Fig. 2.2.
W
common in quadcopters. However, in order to drive these motors, a DC to AC 3
IE
phase sensor-less motor driver is needed. In terms of popular multi-rotor
since their output controls the orientation of the quadcopter by varying the speed
Quadcopters have various configurations though the most common types are the
(a) (b)
W (c)
IE
Figure 2.4: (a): X, (b): H, (c): + configuration quadcopters. In this figure,
arrows represent propeller direction, wires represent rigid frame, and the center
represents the quadframe body.
EV
control. However, this configuration is least ideal for a forward facing camera.
Consequently, very few commercial drones are sold in this configuration and they
achieve improved camera perspective [31]. While this configuration can be ideal
for forward facing cameras, it is also not symmetrical about its center. This lack
of symmetry should be taken into account and will be discussed later in this
W
thesis is to briefly overview the electrical architecture. A block diagram of the
architecture unique to the quadcopter designed in this thesis is shown in Fig. 2.5.
IE
EV
Motor 2 Motor3
3 Phase AC
PR
ESC2 ESC1
Remote
Flight Controller
PPM UART Lidar
Battery 2.4GHz
IMU SPI MCU SPI Radio Radio
3C LIPO 2FSK
PPM
FRONT
ESC3 ESC4
Motor 1 Motor 4