Sie sind auf Seite 1von 7

# AircraftStabilityandControl(AE563)

CourseProject

soonaspossible.

Theclasshas40students.Iwouldliketosee10groupswith4membersineachgroup.

Youwillpresentthepaperinfrontofclass.Wewilldecidethedateandtimeinclasslater.Every
groupwillhave12minutestofinishthepresentation.

Note:Youhavetosubmitasoftcopyofthefollowingbeforethepresentation

1 Presentationslides

willgetanautomaticzerooutof15inthecourseproject.

Pointsdistribution:

Presentation(4points)

Topiccovering(4points)

## Proceedings of the 2011 IEEE

International Conference on Mechatronics and Automation
August 7 - 10, Beijing, China

## Dynamic Analysis and PID Control for a Quadrotor

Jun Li Yuntang Li
College of Mechanical and Electrical Engineering College of Mechanical and Electrical Engineering
China Jiliang University China Jiliang University
Hangzhou, China Hangzhou, China
lijunever@yahoo.com.cn yuntangli@cjlu.edu.cn

Abstract - In order to analyze the dynamic characteristics takeoff and landing, hovering and other movement can be
and PID controller performance of a quadrotor, this paper achieved. For example, tumbling movement can be done if
firstly describes the architecture of the quadrotor and analyzes (2,4) get reverse control signal, pitch movement can be done if
the dynamic model of it. Then, based on the classic scheme of (1,3) get reverse control signal. If we control (1,3) and(2,4) at
PID control, this paper designs a controller, which aims to the same time, yaw movement can be achieved.
regulate the posture (position and orientation) of the 6 d.o.f.
quadrotor. Thirdly, the dynamic model is implemented in
Matlab/Simulink simulation, and the PID control parameters
are obtained according to the simulation results. Finally, a
to do the experimenta flying experiment for the quadrotor
has been done. The results of flying experiment show that the
PID controllers robustly stabilize the quadrotor.
Keywords- Quadrotor; PID controller; Dynamic model
I. INTRODUCTION
A quadrotor is a kind of non-coaxial multi-rotor aircraft
Figure 1. Schematic Diagram of a Quadrotor
which can achieve vertical take-off and landing (VTOL). The
flight attitude control of the quadrotor can be achieved only by
adjusting the speed of the four butterfly-distribution rotors. II. DYNAMIC MODELLING FOR A QUADROTOR
Compared with the conventional rotor-type aircraft, as no tail,
quadrotors have a more compact structure. four rotors lifting In order to get the mathematical modeling for the
force is more uniform than a single rotor, and thus the flight quadrotor, this paper firstly establish , shown in Figure 2.
attitude is more stable. Compared with fixed-wing aircraft, the Of which: the origin of inertial coordinate system E is the
take-off requirements of quadrotor is less, it has other initial position of the quadrotor. The positive direction of OX
advantages for example, it can hover, has a better axis is the designated heading of the quadrotor. The positive
environmental adaptability, and so on [1]. direction of OX axis is up perpendicular to the horizontal
As an important representative of multi-rotor aircrafts, the plane. OY axis is perpendicular to the plane OXZ. This
quadrotor has became a new aviation research frontier in the coordinate system is used to study the relative movement of
field of aviation and aircraft [2]. In the past few years many ground and quadrotor. The quadrotor's spatial coordinates (X,
research effort has been done in this field. Mesicopter [3] was Y, Z) can be obtained through inertial coordinate system, and
an ambitious project, which explored the ways to fabricate thus we can study the position, heading and attitude of the
centimeter-sized vehicles. Such vehicles can be used for quadrotor.
gathering planetary atmospheric and meteorological data. The The origin of quadrotor coordinate system B (Oxyz) is the
X4 Flyer project of Australian National University [5], aims at center of the quadrotor, Ox parallels to the center connection of
developing a quadrotor for indoor and outdoor applications. the front rotor and the rear rotor, and the positive direction
The control system of the vehicle is based on classical control points to the front. Oz parallels to the center connection of the
methodology. Gabe Hoffmann of Stanford University, left rotor and the right rotor, and the positive direction points to
developed a quadrotor that has achieved autonomous flight. the right. Oy axis perpendicular to the plane Oxz, the positive
Scott Hanford, designed HMX4141 quadrotor, which is direction is the direction conform to the right hand rule. This
controlled by the flight control computer in ground station [4]. two coordinate can be converted to each other through
Researchers of Massachusetts Institute of Technology use transition matrix R.
Draganflyer combining with the computer tracking system
have achieved the vision-based hovering, takeoff and landing
[6].
The movement of the quadrotor is generated by the lifting
force which is provided by the motor driven propeller.
According to the quadrotor model diagram (Fig.2), motor (1,3)
and motor (2,4) are two parts which are symmetrical with each
other. By controlling the speed of the four motor, vertical

## 978-1-4244-8115-6/11/\$26.00 2011 IEEE 573

The origin of inertial coordinate system is in the same
position with the geometric center and centroid of the
Resistance and gravity of the quadrotor do not affected
by flight altitude and other factors;
Tensions in all directions are proportional to the square
of the propeller speed. K
Define Fx, Fy, Fz are components of F on the three
coordinate axes of quadrotor coordinate system; p, q, r are
K
components of on the three coordinate axes of quadrotor
coordinate system.
Stress analysis of the quadrotor is shown in Figure 2, where:
Gravity: G = mg
Figure 2. Structure model of the quadrotor
1
Resistance: Di = Cd i2 = kd i2
In figure3, the Euler angles are defined as follows: 2
Yaw angleangle between the X-axis and the projection 1
of Ox in the OXY plane. Lift of a single rotor: Ti = Cti2 = kti2
2
Pitch angleangle between the Z-axis and the projection Newton's second law and dynamics equation of the
of Oz in the OXY plane. quadrotor can be described in vector forms as following:
Roll angleangle between the Y-axis and the projection K
K dV
of Oy in the OXY plane. F =m (5)
Kdt
So, we can get the transition matrix R which is from the
quadrotor coordinate system B (Oxyz) to the inertial frame E K dH
(OXYZ). M= (6)
dt K
1 0 0
Where,F is the external forces acting on the aircraft, m is
Rx = 0 cos sin K
0 sin cos the qualityK of the quadrotor. V is the speed Kof the
(1)
cos 0 sin quadrotor, M is the moment the quadrotor suffered. H is the
angular momentum the quadrotor relative to the ground inertial
Ry = 0 1 0 frame E.
sin 0 cos
() According to mechanical analysis, Newton's second law
and dynamic equation of the quadrotor, the line motion
cos sin 0 equation can be obtained, described as follows:

Rz = sin cos 0 4 2
0 0 1 x = (Fx K1 x) m = kt i ( cos sin cos +sin sin ) K1 x m
(3) i =1
(7)
4 2
cos cos cos sin sin cos sin cos + sin sin y = (Fy K2 y) m = kt i ( sin sin cos cos sin) K2 y m
R = Rx Ry Rz = sin cos sin sin sin sin sin cos sin cos i=1
sin 4 2
cos sin cos cos z = (Fz K3 z mg) m = kt i ( cos cos ) K3 z m g
(4) i=1
The transition matrixes from every axis of quadrotor
According to the relationship between Euler angle and
coordinate system B (Oxyz) to the inertial frame E (OXYZ).
angular velocity of the quadrotor, the following result can be
obtained:
p   sin
q =  cos +  sin cos (8)

r  sin + cos cos
 ( p cos + q sin sin + r cos sin ) cos
Figure 3. Digram of Euler angle.
 (9)
= q cos + r sin
In order to establish the dynamic model of the quadrotor,
without loss of generality, we make the following assumptions

( q sin + r cos ) cos
The quadrotor is a symmetrical rigid body; symmetrical in quality and structure, so the inertia matrix I can
be defined as a diagonal matrix:

574
Ix In the circumstance of no wind and low wind, drag
coefficient can be ignored, so we can get the following model:
I = Iy

(10)
x = ( cos sin cos + sin sin ) U1 m

I z 
K y = ( sin sin cos cos sin ) U1 m
K dH z = ( cos cos ) U1 m g
 (17)
And according to M = (11)
dt   ( I I ) I
 = lU 2 +
y z x
We can get
 
= lU 3 +  ( I z I x ) I y
p
  ( I I ) I
M = I q (12)  = U +
4 x y z

r
By calculating the angular momentum, we can obtain the . DESIGN OF PID ALGORITHM
three axial components angular motion equations of M in the
quadrotor coordinate system, which is Mx, My, Mz. By define U1, U2, U3, U4, the complex nonlinear coupled
model are decomposed to the four independent control
M X pI  xz + qr ( I z I y ) pqI xz
 x rI
channels. So, the model can be viewed as two independent
M = qI
Y y + pr ( I x I z ) + ( p r ) I xz
 2 2 (13) subsystems, which are line movement subsystem and angular
M Z rI movement subsystem.
 z pI
 xz + pq ( I y I z ) + qrI xz We can see from the above, line motion does not affect the
After simplification, the formula is angular motion, but the angular motion affects line motion.
Based on this, we use small perturbation method, after
p [ M x + ( I x I z )qr ] I x ignoring the small perturbation, the motion equation of the
q = M + ( I I )rp I (14) quadrotor is:
y z x y
mx = Ax + Bu
r M z + ( I x I y ) pq I z
x = [ x , y , z, p, q, r , , , ]
T
Where, state variable and
nonlinear motion equations of the quadrotor can be
controlled variable u = [u1 , u2 , u3 , u4 ] .Because there is a
T
obtained by combining the line motion equation and angular
motion equation: quasi-integral relation between the attitude angle and angular
4 velocity, in order to simplify the control system, suppose there
x = ( Fx K1 x) m = kt i2 ( cos sin cos + sin sin ) K1 x m

i =1 is simple integral relation:
4 2  = p  = q  = r
y = ( Fy K2 y ) m = kt i ( sin sin cos cos sin ) K2 y m (15)
i =1 When straight flying, the longitudinal motion equation of
quadrotor is x g = Ag xg + Bg u g , where, state variable
z = (Fz K3 z mg ) m = kt i2 ( cos cos ) K3 z m g
4

i =1
xg = [ x , z, q, ] , controlled variable u g = [u1 , u4 ] .
T T

p = M x + (I y I z )qr I x
Coefficient matrix is as follows:
q = M y + (I z I x )rp I y
xx xz xq x xt
x
r = M z + (I x I y ) pq I z z
z z zq z 0
z
Ag = x Bg =
 (18)
 = ( p cos + q sin sin + r cos sin ) cos
 mx mz mq m 0
m
= q cos + r sin
 = ( q sin + r cos ) cos 0 0 1 0 00
Where, l is the distance between the center of the rotor and When horizontal flying, the motion equation of quadrotor
the origin of the coordinate system. Ki is drag coefficient. is xh = Ah xh + Bh uh , where, state variable xh = [ v, p, r , , ]T ,
DefineU1, U2, U3, U4, as the inputs of the four independent
controlled variable us = u2 .
control channels:
Coefficient matrix is as follows:
4

kt i2 yv y p yr y 0
U1 F1 + F2 + F3 + F4
i =1
l
U 2 = F4 F2 = kt (42 22 ) (16) v l p lr l 0 (19)
U 3 F3 F1 Ag = nv n p nr n 0
k ( 2
2
)
0 1 0 0 0

U 4 F2 + F4 F3 F1
t 3 1

kd (12 22 + 32 42 ) 0 0 1 0 0

Where, U1 is vertical speed control input ; U2 is roll control
input; U3 is pitch control input; U4 is yaw control input; is
rotor speed; F is the tension rotor suffered.

575
TABLE II. PARAMETER OF SIMULATION
y
l
(20) N Kpn Kin Kdn
Bg = n
1 2 0.01 1
0
0 2 2 8 0.1
According to the data of the quadrotor, as well as relative 3 3 0.01 1
references, we can get the parameter table of the quadrotor:
4 3 10 0.1
TABLE I. THE PARAMETER TABLE OF THE QUADROTOR
5 5 5 1
Parameter Unit Value
6 30 1 1
M kg 1.2
L m 0.2
Kt Ns2 3.13e-5
2
Kd Nms 7.5e-7
Ix kgm2 2.353e-3
Iy kgm2 2.353e-3
Iz kgm2 5.262e-2
According to the transfer function G ( s) = (sI A) 1 B and
parameter table of the quadrotor, we can get the transfer 
function of each channel: Figure 4. Simulink model of PID controller
Pitch channel:
56.95 s + 4391 (21) The simulation results show that the system overshoot is
G = =
s 3 + 105 s 2 + 870 s + 4430
1
u1 small, steady-state error is almost zero, the system response is
Roll channel: fast and the performance can be improved. System simulations
65s + 4560 (22) verify the effectiveness of the design of the control method.
G2 = =
u2 s 3 + 109 s 2 + 1023s + 2935 1.4
Yaw channel: 1.2
105 1
G3 = = (23)
u3 s + 413s 2
(ra d )

0.8
X-axis direction and pitch angle: 0.6
x x 190 s + 567 (24) 0.4
G4 = = =
s s (57.95s + 4400)
0.2
Z-axis:
z 0
z 1.63 (25) 0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
G6 = = = t(s)
u4 su4 s ( s + 5)
(a) Step response of yaw angle
Z-axis direction and roll angle: 1.4
y y 276.4 s + 743.5 1.2
G5 = = = (26)
s s(61s + 4463) 1
0.8

## . SIMULATION AND EXPERIMENT 0.6

Based on PID system structure, simulink model is 0.4
built(figure.4) and simulation is done, through commissioning, 0.2
values is obtained and shown in Table 2, the step response of 0
position and attitude of the designed controller are shown in 0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Figure5, followed by the yaw angle, pitch angle, roll angle, X t(s)
(b) Step response of pitch angle
axis, Z axis and Y axis.

576
With respect to the mechanical structure, the frame of the
of the aircraft and four motor carriers are made by high-
1
strength 3K carbon fiber board and the cross-type frame is
0.8
(ra d )

## made of carbon fiber rectangular intersections pipe. Carbon

0.6 fiber is of light weight, high strength, corrosion resistance, long
0.4 life and other excellent characteristics. The landing gear of the
0.2 quadrotor is the commercial one U380. The cross-type frame
and chassis, as well as the chassis and landing gear is
0 connected by m5 hex bolts. The overall mechanical structure is
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
t(s) simple and practical, which meet the requirements of the
(c) Step response of roll angle design of quadrotor.
1.4
1.2
1
0.8
x(m)

0.6
0.4
0.2
0
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
t(s)
(d) Step response of X axis position

1.4
1.2

1
Figure 6. Picture of the Quadrotor
0.8
z(m)

## 0.6 Experiment sites are selected in low-speed wind and

0.4 obstacle-free places. When doing the test, firstly we increase
0.2 the throttle, do not control the attitude of the quadrotor, so that
0 the quadrotor will vertical launch. The test shows that the PID
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
t(s) controller can adjust the posture changes caused by wind or
other disturbances. The attitude data can be collected by
(e) Step response of Z axis position
angular speed sensors carried by the quadrotor itself, and
1.4 transfer to the lower level computer by bluetooth
1.2 equipment.The results shown in Figure 5, where the abscissa
1 units is 10ms, the vertical axis unit is 0.1 . The quadrotor
0.8 lifted-off in 44s; in 44 ~ 54s, it was in the air; as is shown in
y(m)

0.6 figure5, the pitch angle, the roll angle and yaw angle all change
0.4 little (5 or less).
0.2 50
Pitch Angle
0 40
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5 30
Roll Angle
t(s) Yaw Angle
20
(f) Step response of Y axis position 10
0 .1

## Figure 5. Step Response of Position and Attitude 0

-10
The simulation results only can be a reference, can not be -20
directly used for the actual flight. Therefore, this paper design a -30
outdoor test, through the test, parameters can be obtained -40
eventually. -50
440 450 460 470 480 490 500 510 520 530 540
In order to do the test, we design a experimental quadrotor. t(0.1s) 
It has three main tasks. Firstly, it achieves stable flight so that Figure 7. Test Results of the Flying Experiment
we can do further research for the flight control system.
Secondly, through the quadrotor, we want to design a new
mechanical structure and search for the new materials which
are suitable for making quadrotor. Thirdly, equipped with high-
definition camera, it will do fixed-point aerial photography
supported by GPS.

577
. CONCLUSION
This paper describes the architecture of a quadrotor and
analyzes the dynamic model of it. A quadrotor is designed and
made for the experiment. Based on the classic scheme of PID
control, this paper designs a controller, which aims to regulate
the posture (position and orientation) of the 6 d.o.f. quadrotor.
Simulation and experimental studies had been done to the
control system.
The simulation results show that the system overshoot is
small, at the same time the steady-state error is almost zero,
and the system response is fast, which is to say that the
performance can be improved by PID controller. So the system
simulations of verify the effectiveness of the design of the
control method.
The experiment results show that the quadrotor can achieve
attitude stabilization if the PID parameters are appropriate.
ACKNOWLEDGEMENTS
This work was sponsored by the National Nature & Science
Foundation of China under Grant 50905171, Nature & Science
Foundation of Zhejiang Province, China under Grant
Y1080100, and State Key Laboratory of Mechanical System
and Vibration of China (Shanghai Jiaotong University) under
Grant MSV-2009-09.
REFERENCES
[1] Ly Dat Minh; Cheolkeun Ha; , "Modeling and control of quadrotor
MAV using vision-based measurement," Strategic Technology (IFOST),
2010 International Forum on , vol., no., pp.70-75, 13-15 Oct. 2010
[2] Santos, M.; Lpez, V.; Morata, F.; , "Intelligent fuzzy controller of a
quadrotor," Intelligent Systems and Knowledge Engineering (ISKE),
2010 International Conference on , vol., no., pp.141-146, 15-16 Nov.
2010.
[3] Jun Wu; Hui Peng; Qing Chen; , "RBF-ARX model-based modeling and
control of quadrotor," Control Applications (CCA), 2010 IEEE
International Conference on , vol., no., pp.1731-1736, 8-10 Sept. 2010.
[4] Mian, A.A.; Wang Daobo; , "Nonlinear Flight Control Strategy for an
Underactuated Quadrotor Aerial Robot," Networking, Sensing and
Control, 2008. ICNSC 2008. IEEE International Conference on , vol.,
no., pp.938-942, 6-8 April 2008
[5] Gonzlez-Vzquez, S.; Moreno-Valenzuela, J.; , "A New Nonlinear
PI/PID Controller for Quadrotor Posture Regulation," Electronics,
Robotics and Automotive Mechanics Conference (CERMA), 2010 , vol.,
no., pp.642-647, Sept. 28 2010-Oct. 1 2010
[6] Salih, A.L.; Moghavvemi, M.; Mohamed, H.A.F.; Gaeid, K.S.; ,
"Modelling and PID controller design for a quadrotor unmanned air
vehicle," Automation Quality and Testing Robotics (AQTR), 2010 IEEE
International Conference on , vol.1, no., pp.1-5, 28-30 May 2010.

578