Dynamic Modeling of Fixed-Wing UAVs (12.05.2006)
Dynamic Modeling of Fixed-Wing UAVs (12.05.2006)
Dynamic Modeling of Fixed-Wing UAVs (12.05.2006)
Version 2.0
12/2006
Dynamic Modeling of Fixed-Wing UAVs Dec 2006
1 Introduction
Dynamic modeling is an important step in the development and the control of a dynamic
system. In fact, the model allows the engineer to analyze the system, its possibilities and its
behavior depending on various conditions. Moreover, dynamic models are widely used in
control design.
This is especially important for aerial robots where the risk of damage is very high as a fall
from a few meters can seriously damage the platform. Thus, the possibility to simulate and
tune a controller before implementing it on the real machine is highly appreciable.
In this course, one will se the simplified example dynamic modeling of a lightweight model
airplane for which the Lagrange-Euler formalism will be used.
1.1 Objectives
The main objective of this course is to introduce the modeling of unmanned aerial vehicles
through the example of Sky-Sailor airplane used in research. The second objective is to make
the reader aware of the importance of modeling for engineers, especially for controlling
systems. The model presented below is derived for system’s analysis, control-law design and
simulation. Fig. 1 shows a situation where a model is used for control design.
PLANT’S
CONTROLLER
SCOPE MODEL
REFERENCE
In this document, we use Tait-Bryan angles to describe the orientation of our UAVs. It
consists of three successive rotations:
r
• Rotation of φ around x : roll (-π<φ<π)
r
• Rotation of θ around y : pitch (-π/2<θ<π/2)
r
• Rotation of ψ around z : yaw (-π<ψ<π)
The complete rotation matrix, called Direct Cosine Matrix is then [5]:
R (φ , θ ,ψ ) = R ( z ,ψ ) ⋅ R ( y , θ ) ⋅ R ( x, φ )
⎡ cosψ cos θ cosψ sin θ sin φ − sin ψ cos φ cosψ sin θ cos φ + sin ψ sin φ ⎤
R (φ , θ ,ψ ) = ⎢ sin ψ cos θ sin ψ sin θ sin φ + cosψ cos φ sin ψ sin θ cos φ − sin φ cosψ ⎥ (1)
⎢ ⎥
⎢⎣ − sin θ cos θ sin φ cos θ cos φ ⎥⎦
⎢⎣ r ⎥⎦ ⎢.⎥
⎢ψ ⎥
⎣ ⎦
Where:
⎡1 0 − sin θ ⎤
⎢
Rr = ⎢ 0 cos φ sin φ cos θ ⎥⎥ (3)
⎢⎣ 0 − sin φ cos φ cos θ ⎥⎦
1
Notation used in aerospace engineering
b
c
pitch
a B
roll x b
Y z
E
X yaw
Fl
Angle of attack
Trailing edge
Fd
Chord
Relative
Wind 25 % Chord Thickness
Figure 10: Section of the wing (airfoil) and the lift and drag forces
The application point of the lift and drag forces is very close to the 25% of the chord but
this can slightly change depending on the angle of attack. In order to simplify the problem,
the application point is considered as fixed and a moment is added to correct this
assumption.
ρ
Fl = Cl Sv 2 (18)
2
ρ
Fd = Cd Sv 2 (19)
2
ρ
M = Cm Sv 2 ⋅ chord (20)
2
with ρ : Density of fluid (air)
S : Wing area
v : Flight speed (relative to surrounding fluid)
CL : Lift coefficient
CD : Drag coefficient
CM : Moment coefficient
The lift, drag and moment coefficients depend on the airfoil, the angle of attack and a third
value that is the Reynolds number. It is representative of the viscosity of the fluid but will
not be explained more in details. Cl increases almost linearly with the angle of attack until
the stall angle is reached. The wing should never work in this zone where the Cl decreases
importantly which makes the airplane loosing altitude very rapidly. Cd has a quadratic
relation to the angle of attack.
As we state it in the hypothesis, we assume that the inertia matrix is diagonal and thus, that
the inertia products are null. The kinetic energy due to the rotation is:
1 1 1
Ecin rotation = I xxω x2 + I yyω y2 + I zzω z2 (24)
2 2 2
Where ω , ω , ω are the rotational speed that can be expressed as a function of the roll,
x y z
pitch and yaw rate (φ&,θ&,ψ& ) :
T=
1
2
( mx& 2
+ my& + mz&
2 2
+ I xxω x2 + I yyω y2 + I zzω z2 ) (26)
The Lagrangian is :
L = T −V (28)
d ⎛ ∂L ⎞ ∂L
⎜ ⎟ − = mz&& − mg cos φ cos θ (33)
dt ⎝ ∂z& ⎠ ∂z
d ⎛ ∂L ⎞ ∂L
⎜ ⎟− = I xxω& x − ( I yy − I zz )ω yω z (34)
dt ⎝ ∂φ& ⎠ ∂φ
d ⎛ ∂L ⎞ ∂L
⎜ ⎟− = − sin φ (ω& z I zz − ω xω y ( I xx − I yy ))
dt ⎝ ∂θ& ⎠ ∂θ (35)
+ cos φ (ω& y ⋅ I yy − ω xω z ( I zz − I xx ))
d ⎛ ∂L ⎞ ∂L
⎜ ⎟− = − sin θ ⋅ (ω& x I xx − ω yω z ( I yy − I zz ))
dt ⎝ ∂ψ& ⎠ ∂ψ
+ sin φ cos θ ⋅ (ω& y I yy − ω xω z ( I zz − I xx )) (36)
+ cos φ cos θ ⋅ (ω& z I zz − ω xω y ( I xx − I yy ))
The non-conservative forces and moments come from the aerodynamics. On the airplane,
seven parts are considered as depicted on the figure below where the right and left side of
are divided into a portion with and without control surface.
Fl5
M7 Fl7
M5 Fl6
Fd5
Fl4 Fd7
M4 Fd6
Fd4 M6
Fl3
M3
Fd3
Fl2
M2 Fl1
Fd2
Fprop M1
Fd1
7
Ftot = Fprop + ∑ FLi + Fdi
i =1
7
M tot = ∑ M i + FLi × ri + Fdi × ri
i =1
Fprop = f ( x&, U1 )
ρ
Fli = Cli Si v 2
2
ρ (37)
Fdi = Cdi Si v 2
2
ρ
M i = Cmi Si v 2 ⋅ chordi
2
[Cl 6 Cd 6 Cm 6 ] = f ( Aoai ,U 4 )
[Cl 7 Cd 7 Cm7 ] = f ( Aoai ,U 5 )
U1 to U5 are the control inputs: U1 is the voltage on the motor and U2, U3, U4, U5 are
respectively the deflection of the left aileron, the right aileron, the left V-tail and the right
V-tail.
Isolating the acceleration and applying the small angle approximation, where the rotational
speed in the solid basis are equal to Euler’s angles rates, we obtain:
⎧ F ⎧ Ftot , X
⎪ &&x = tot , x − g sin θ ⎪ X&& =
⎪ m ⎪ m
⎪ && Ftot , y ⎪Y&& = tot ,Y
F
⎪ y = m + g sin φ cos θ ⎪ m
⎪ F ⎪ Ftot , Z
⎪ &&z = tot , z + g cos φ cos θ ⎪ Z&& = m + g
m
⎪⎪ ⎪⎪
⎨φ&& = I yy − I zz ψθ M tot , x or in Earth frame ⎨φ&& = I yy − I zz ψθ M tot , x (39)
&&+ &&+
⎪ I xx I xx ⎪ I xx I xx
⎪ ⎪
⎪ && I zz − I xx & M tot , y ⎪ && I zz − I xx & M tot , y
⎪θ = I ψφ
& +
I yy
⎪θ = I ψφ
& +
I yy
⎪ yy ⎪ yy
⎪ I −I M ⎪ I −I M
⎪ψ&& = xx yy θφ & & + tot , z ⎪ψ&& = xx yy θφ & & + tot , z
⎪⎩ I zz I zz ⎪⎩ I zz I zz
Note that only the angular dynamics were developed using the Lagrangian approach.
4 Model verification
Like all models, the airplane model developed above contains physical parameters which
must be known with good precision.
These parameters are also m, Ixx, Iyy, Izz and all the aerodynamic coefficients Cli, Cdi, Cmi that
depends on the speed and the angle of attack. There exist software that allow a calculation of
these values but the better way is for sure a direct measurement of the forces and the torques
on a piece of the wing placed in a wind tunnel.
5 References
[1] http://www.asl.ethz.ch/
[2] R.M. Murray, Z. Li, and S.S. Sastry, A mathematical introduction to robotic manipulation. CRC
Press, 1994.
[3] S. Boubdallah, P.Murrieri and R.Siegwart, Design and Control of an Indoor Micro Quadrotor.
ICRA 2004, New Orleans (USA), April 2004.
[4] S. Boubdallah, A.Noth and R.Siegwart, PID vs LQ Control Techniques Applied to an Indoor
Micro Quadrotor. IROS 2004, Sendai (Japan), October 2004.
[5] R. Olfati-Saber, Nonlinear Control of Underactuated Mechanical Systems with Application to
Robotics and Aerospace Vehicles. Phd thesis, Department of Electrical Engineering and Computer
Science, MIT, 2001.
[6] H. Baruh, Analytical Dynamics.McGraw-Hill, 1999.
[7] A. Noth, Synthèse et Implémentation d’un Contrôleur pour Micro Hélicoptère à 4 Rotors, Diploma
Project 2004.
[8] Robert F. Stengel, Flight dynamics. Princeton University Press, 2004.
[9] A. Noth, W. Engel, R. Siegwart, Design of an Ultra-Lightweight Autonomous Solar Airplane for
Continuous Flight. In Proceedings of Field and Service Robotics, Port Douglas, Australia, 2005.
[10] http://www.mh-aerotools.de/airfoils/javafoil.htm
[11] http://en.wikipedia.org/wiki/Tait-Bryan_angles