Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
DOI 10.1007/s10846-013-9947-y
Received: 30 August 2013 / Accepted: 13 September 2013 / Published online: 4 October 2013
Springer Science+Business Media Dordrecht 2013
Abstract In the last decades, the increasing interest in unmanned aerial vehicles for both military
and civil applications made necessary the development of flight control theory and algorithms
more and more efficient and fast. In this paper, an
original trajectory controller, like a Proportional
Integrative Derivative one, is taken into account
and the drone structure assumes a hexacopter
configuration, i.e. it consists of six rotors, located
on the vertices of a regular hexagon with three
pairs of counter-rotating fixed pitch blades. The
motion of unmanned aerial vehicle is described
by means of the Newton-Euler equations in terms
of quaternions, in order to improve the numerical efficiency and stability of the controller algorithm, whose novelty lies in the quaternion error
1 Introduction
The interest of the research community for Unmanned Aerial Vehicle (UAV) design is fast
growing up with the aim of developing cheaper
and more capable machines. Their military and
civil applications vary from surveillance and reconnaissance to search and rescue, but, overall,
the main UAV goal is to avoid any risk to aircrew
[13, 15, 18].
Thanks to their mechanical structure and control systems, multirotor mikrokopter gain some
advantages over vertical takeoff and landing
UAVs [7, 9], that can be summarized as follows.
The propeller layout is fixed-pitch based and the
control is realized by adjusting the angular velocity of the rotors. This simplifies both the design
and maintenance procedures for the vehicle such
that any complex mechanical system is required
262
Derivative (PD) controller illustrated in [6], is described. Both mathematical model and controller
technique are formulated in terms of quaternion
as shown in [5]. In conclusion, some trajectories,
with several check points, have been chosen as
desired ones for testing and validating both dynamical model and control system.
263
(1)
(2)
(4)
u(t) = K P e(t) + K I
e(s)ds + K D
d
e(t)
dt
(5)
(6)
q =
d
(S )
dt
(3)
(7)
(8)
(9)
264
1
dz + g
q0 = +
q23
2 2 d2 + d2 + (d + g)2
z
x
y
T=
m(dz + g)
2(q20 + q23 ) 1
q1 =
m(dx q3 d y q0 )
(q20 + q23 )2T
q2 =
m(dx q0 + d y q3 )
(q20 + q23 )2T
(10)
2.980e-6
1.140e-7
0.225
9.81
0.468
4.856e-3
4.856e-3
8.801e-3
3.357e-5
[kg m]
[kg m2 ]
[m]
[m/s2 ]
[kg]
[kg m2 ]
[kg m2 ]
[kg m2 ]
[kg m2 ]
4 Numerical Simulations
(11)
(12)
(13)
T
2
,
6k 5kl 10b
(14)
22 =
+
,
6k 3kl 5kl 5b
(15)
32 =
+
+
,
6k 3kl 5kl 5b
(16)
42 =
T
2
+
+
,
6k 5kl 10b
(17)
52 =
,
6k 3kl 5kl 5b
(18)
+
.
6k 3kl 5kl 5b
(19)
62 =
k
b
d
g
m
Ixx
I yy
Izz
Ir
This paragraph deals with several numerical simulations presented and discussed in order to prove
the efficiency, stability and well-working of the
algorithm shown in the previous section. The control algorithm has been codified by using MATLAB software and its routine for the integration
of Differential Equations has been employed.
In [6], the PD technique has been applied in
order to control basic trajectories and to analyze
the role played by the angular velocities in the
flight, with respect to the symmetry of both trend
and structure of the drone. Starting from the same
results obtained by means of the improved PID
controller, in this paper, not elementary trajectories have been chosen with the aim of trying the
reliability of the new method.
Given a desired position and orientation, the
main idea consists of considering a sequence of
check-points along the trajectory and requiring
that the drone passes across them with a certain
attitude. The set of physical constants adopted in
the dynamical system during the whole experimentation, is reported in Table 1, while the parameters of the PID controller are shown in Table 2.
Table 2 Constants used
for the PID controller
Ki,P
Ki,I
Ki,D
x
y
z
0.2
1
10
0.25
0.25
0.3
0.02
0.13
5
0.75
3.1
10
0.25
0.25
0.25
265
x = cos()
y = sin()
z =1
=1
(20)
[0, 2]
1.5
Xd
X
0.8
0.6
0.4
position [m]
0.5
position [m]
x
y
z
0.5
0.2
0
0.2
0.4
0.6
0.8
1
1.5
1.5
0.5
0
time [s]
0.5
1.5
25
500
1000
1500
2000
time [s]
2500
3000
3500
500
1000
1500
2000
time [s]
2500
3000
3500
4.5922
yaw
4.592
4.5918
15
Thrust [N]
20
10
4.5916
4.5914
5
0
0
4.5912
6
time [s]
10
4.591
0
266
Hexacopter position and attitude corresponding to both simulations are reported in Figs. 2
and 3 respectively.
Along the two trajectories, 121 check points
have been fixed and the orientation required to
the drone is again 20 degrees.
In Fig. 2, where the desired position corresponds
to a = 3, b = 1, c = 3, d = 1, the actual position of
the aircraft is reported distinguishing the movement in the XY-plane, with also the check-points
(LEFT), from the x, y and z evolution in time
(RIGHT). The other controlled variable is the
yaw angle , depicted in Fig. 2 (DOWN-LEFT)
showing that the 20 degrees in orientation is
reached in less then 8 s. Finally, Fig. 2 (DOWN-
x = cos(a) cos3 (b )
z =1
[0, 2] .
(21)
2.5
2
Xd
X
x
y
z
1.5
1.5
1
0.5
position [m]
position [m]
0
0.5
0.5
0
0.5
1
1
1.5
1.5
2
2.5
1.5
0.5
0
time [s]
0.5
2
0
1.5
1000
2000
3000
4000
5000
3000
4000
5000
time [s]
25
4.5924
yaw
4.5922
20
15
Thrust [N]
4.592
10
4.5918
4.5916
4.5914
4.5912
5
4.591
0
0
10
time [s]
1000
2000
time [s]
267
2
2
Xd
X
0.5
0.5
0
0.5
0
0.5
1.5
1.5
2
2
1.5
0.5
0
time [s]
0.5
1.5
x
y
z
1.5
position [m]
position [m]
1.5
2
0
1000
2000
3000
4000
5000
3000
4000
5000
time [s]
4.594
25
yaw
4.5935
20
15
Thrust [N]
4.593
10
4.5925
4.592
4.5915
5
4.591
0
0
10
4.5905
0
1000
time [s]
2000
time [s]
a
[0, n]
y
=(ab
)
sin()b
cos
z =1
(22)
268
2.5
2.5
Xd
X
1.5
1.5
0.5
0.5
0
0.5
0
0.5
1.5
1.5
2.5
3
2.5
0
x
y
z
position [m]
position [m]
1000
2000
3000
4000
time [s]
5000
6000
7000
1000
2000
3000
4000
time [s]
5000
6000
7000
time [s]
25
4.597
yaw
4.596
20
15
Thrust [N]
4.595
10
4.594
4.593
4.592
5
4.591
0
0
10
time [s]
Fig. 4 Case 3.1: UP the Figure shows desired position corresponding to a = 2.5, b = 1, n = 8 (
) and actual position
(continuous line) in the XY plane (left) and the three
4.59
0
269
2
2
Xd
X
0.5
0.5
0
0.5
0
0.5
1.5
1.5
2
2
x
y
z
1.5
position [m]
position [m]
1.5
2
0
1000
2000
3000
4000
time [s]
5000
6000
7000
1000
2000
3000
4000
time [s]
5000
6000
7000
time [s]
25
4.5945
yaw
4.594
20
15
Thrust [N]
4.5935
10
4.593
4.5925
4.592
4.5915
5
4.591
0
0
10
time [s]
4.5905
0
Fig. 5 Case 3.2: UP the Figure shows desired position corresponding to a = 1.8, b = 1, n = 10 (
) and actual position
(continuous line) in the XY plane (left) and the three
5 Concluding Remarks
270
large enterprises; (Prog. Mezzo Aereo a controllo remoto per il Rilevamento del TErritorio - MARTE Grant
No.10772131).
References
1. Alaimo, A., Artale, V., Milazzo, C.L.R., Ricciardello,
A.: Comparison between euler and quaternion parametrization in uav dynamics. In: AIP Conference Proceedings (2013)
2. Artale, V., Barbaraci, G., Milazzo, C.L.R., Orlando, C.,
Ricciardello, A.: Dynamic analysis of a hexacopter controlled via LQR-PI. In: AIP Conference Proceedings
(2013)
3. Artale, V., Collotta, M., Pau, G., Ricciardello, A.:
Hexacopter Trajectory Control using a Neural Network. In: AIP Conference Proceedings (2013)
4. Artale, V., Milazzo, C., Ricciardello, A.: An example of
quaternion parameterization for dynamical simulation.
In: International Conference on Mathematical Modeling in Physical Sciences, IC-MSQUARE Conference
Proceedings Book (2013)
5. Artale, V., Milazzo, C., Ricciardello, A.: Mathematical
modeling of hexacopter. Appl. Math. Sci. 7(97), 4805
4811 (2013)
6. Alaimo, A., Artale, V., Milazzo, C., Ricciardello,
A., Trefiletti, L.: Mathematical modeling and control
of a hexacopter. In: ICUAS13 Conference Digital
Proceedings Simulator Aero Model Implementation
(2013)
7. Alderete, T.S.: Simulator aero model implementation,
NASA Ref. Pub. 1373, DOT/FAA/CT-94/83 (1995).
Available online: www.aviationsystemsdivision.arc.nasa.
gov/publications/hitl/rtsim/Toms.pdf. Accessed 7 Nov
2011
8. Castillo, P., Lozano, R., Dzul, A.: Modelling and
control of mini-flying machines. Springer, New York
(2005)
9. Hoffmann, G.M., Huang, H., Waslander, S.L., Tomlin,
C.J.: Quadrotor helicopter flight dynamics and control:
theory and experiment. In: Proceedings of the AIAA
10.
11.
12.
13.
14.
15.
16.
17.
18.
19.