Advanced UAVs Nonlinear Control Systems and Applications
Advanced UAVs Nonlinear Control Systems and Applications
6,500
Open access books available
177,000
International authors and editors
195M
Downloads
154
Countries delivered to
TOP 1%
most cited scientists
12.2%
Contributors from top 500 universities
Abstract
Recent development of different control systems for UAVs has caught the
attention of academic and industry, due to the wide range of their applications such
as in surveillance, delivery, work assistant, and photography. In addition, arms,
grippers, or tethers could be installed to UAVs so that they can assist in construc-
ting, transporting, and carrying payloads. In this book chapter, the control laws of
the attitude and position of a quadcopter UAV have been derived basically utilizing
three methods including backstepping, sliding mode control, and feedback lineari-
zation incorporated with LQI optimal controller. The main contribution of this book
chapter would be concluded in the strategy of deriving the control laws of the
translational positions of a quadcopter UAV. The control laws for trajectory
tracking using the proposed strategies have been validated by simulation using
MATLAB®/Simulink and experimental results obtained from a quadcopter test
bench. Simulation results show a comparison between the performances of each of
the proposed techniques depending on the nonlinear model of the quadcopter
system under investigation; the trajectory tracking has been achieved properly for
different types of trajectories, i.e., spiral trajectory, in the presence of unknown
disturbances. Moreover, the practical results coincided with the results of the
simulation results.
1. Introduction
1
Unmanned Robotic Systems and Applications
2
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
3
Unmanned Robotic Systems and Applications
feedback linearization with LQR, has been performed in [21]. The control laws have
been derived depending on the nonlinear model with no linearization, and experi-
ments for the attitude have been performed. Whereas in [22], the performance of
sliding mode techniques has been verified and sat function has been used in order to
obtain a continuous control law instead of sign function [23]. This shows nonlinear
control laws applied for optimal trajectory tracking depending on minimum snap
theory, and differential flatness method is utilized to derive control laws that link
between the system outputs and its inputs. Reference [24] focuses on sliding mode
control of the quadcopter; the proposed approach consisted of a sliding mode
observer with finite-time process, a hybridization of a PID conventional controller,
and a continuous sliding-mode one. The main aim is to estimate the system’s state
vector based on the measured system’s output states and to identify a certain type of
the inherited system’s disturbances simultaneously. It is also to track a desired time-
varying trajectory in spite of the influence of external disturbances and uncer-
tainties. Finally, fractional order sliding mode control is used to derive the attitude
control laws of a quadcopter, where PD tracking controllers are used to control the
position of the quadcopter in [25].
Nonlinear control theory is the area of control theory that deals with nonlinear
systems, time variant systems, or both. Different engineering applications motivate
researchers to develop powerful nonlinear control methods, since a majority of
these systems are considered to be nonlinear. The key reason behind the use of
nonlinear control techniques is their capability to deal with the nonlinear charac-
teristics of nonlinear systems such as underactuations, models uncertainty, and
dynamic coupling. This chapter focuses on the following nonlinear control
approaches:
1. Backstepping
3. Feedback linearization
2.1 Backstepping
x_ 1 ¼ x2
x_ 2 ¼ f ðxÞ þ g ðxÞu (1)
y ¼ x2
4
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
e1 ¼ x1d x1 (2)
1
u¼ ðx1d þ ke1 f ðxÞÞ (5)
gðxÞ
Feedback linearization is also one of the major nonlinear design tools. It is used
to cancel the nonlinear terms in a system’s model; this cancellation resulting in a
linear system allows designing and incorporating linear controllers for a nonlinear
system with the feedback linearization laws. To introduce the procedure of this
strategy, we first introduce the notions of full-state linearization, where the state
equation is completely linearized, and input-output linearization, where the
input-output map is linearized, while the state equation may be only partially
linearized [26].
In this chapter, we will pay attention to input-output linearization method. To
obtain the input-output feedback linearization law, we simply repeat the calculation
of the derivative of the system output along the state variables. Let us consider the
system in (1) as,
y ¼ x2 , y_ ¼ x_ 2 (6)
1
u¼ ð f ðxÞ þ υÞ (7)
g ðx Þ
Sliding mode control is considered one of the control tools of the variable
structure systems (VSS), since it produces a discontinuous controller. It has the
advantage of stabilizing and achieving robustness criteria against model uncertainty
and disturbances. Sliding mode control theory depends on a sliding surface s,
where the sliding mode controller constrains a system to it. The motion toward the
sliding surface consists of a reaching phase during which trajectories starting off
5
Unmanned Robotic Systems and Applications
Figure 1.
Illustration of sign function.
the surface s = 0 move toward it and reach it in finite time, followed by a sliding
phase during which the motion is confined to the surface s [26, 28].
Equivalent control law is one of the sliding mode control strategies; it consists of
two terms, the first is produced by equaling the derivative of sliding surface s to 0.
The other term is called reaching law that has some common formulas such as [28]:
and constant plus proportional rate reaching law, i.e., s_ ¼ Qs K sgn ðsÞ.
1ð:Þ
s ¼ c0 e þ c1 e_ þ …… þ cd 1 eρ þ eρð:Þ (8)
3. Equaling the derivative of sliding surface with the appropriate reaching law
3. Quadcopter modeling
The dynamic model of the quadcopter is delivered in this section; the details of
the model can be seen in the literature [29–31]. The state variables of the quadcopter
_ ψ_ T where ζ ¼ ½x; y; zT is the position
are defined as, X ¼ x; y; z; x;
_ y;
_ z;
_ φ; θ; ψ; φ;
_ θ;
described in the inertial coordinate frame B, V ¼ ½x; _ z_ T is the translational
_ y;
6
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
velocity, η ¼ ½φ; θ; ψ T are the roll-pitch-yaw angles describing the attitude of the
_ ψ_ T are the Euler angle rates of the quadcopter described
quadcopter, and η_ ¼ φ; _ θ;
in the body-fixed frame A.
where BRA is the transformation matrix
U1
x€ ¼ ðcφsθcψ þ sφsψ Þ
m
U1
y€ ¼ ðcφsθsψ sφsψ Þ
m
U1
z€ ¼ ðcφcθÞ g
m
(10)
Izz Iyy _ J 1
φ€ ¼ θ ψ_ þ r Ωr θ_ þ U2
Ixx Ixx Ixx
Izz Ixx Jr 1
θ€ ¼ φ_ ψ_ Ωr φ_ þ U 3
Iyy Iyy Iyy
Ixx Iyy 1
ψ€ ¼ φ_ θ_ þ U4
Izz Izz
U1 ¼ f 1 þ f 2 þ f 3 þ f 4
U2 ¼ l f 4 f 2
(11)
U3 ¼ l f 3 f 1
U4 ¼ T1 T2 þ T3 T4
where f i ¼ bω2i is the thrust force produced by propeller i with thrust coefficient
b in Ns2/m and ωi is the angular speed of motor i.
T i ¼ dω2i is the drag torque produced by propeller i in Nm with corresponding
drag coefficient d in N2s, l is the distance between center of the quadcopter and
center of propeller in m, I is the inertia matrix, and Ixx, Iyy, and Izz are moments of
inertia about x, y, and z axes, respectively, in kgm2.
where Jr is the moment of inertia of the propeller and Ωr is the sum of the four
motors’ angular speed. Based on the above derivation and discussion,
U1 b b b b ω21
2 3 2 323
6U 7 6 0 bl 0 bl 76 27
6 27 6 76 ω2 7
U¼6 7¼6 (12)
4 U 3 5 4 bl 0 bl 0 54 ω23 5
76 7
U4 d d d d ω24
7
Unmanned Robotic Systems and Applications
4. Quadcopter control
Control laws of the attitude and position of the quadcopter are derived using
integral backstepping approach.
We will start deriving the control law of the attitude by defining the altitude
error and the Lyapunov function as follows:
1
e1 ¼ zd z, V 1 ¼ e21 (13)
2
If the term k1e1 is added and subtracted to the V_ 1 function, where k1 > 0, it yields
V_ 1 ¼ e1 e_ 1 ¼ e1 ðz_ d V z þ k1 e1 k1 e1 Þ (14)
1
e2 ¼ vzd vz , V 2 ¼ e22 (17)
2
Figure 2.
The block diagram of the position control system of the quadcopter.
8
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
cφcθ
V_ 2 ¼ k2 e22 þ e2 v_ zd U 1 þ g þ k2 e2 (18)
m
m
U1 ¼ fz€d þ k1 e_ 1 þ g þ k2 e2 g (19)
cφcθ
The control laws of the attitude of the quadcopter were derived in this section
depending on integral backstepping method as follows:
1
U2 ¼ φ€ þ k3 e_ 3 a1 θ_ ψ_ a2 θΩ _ r þ k4 e4 (20)
b1 d
1 €
U3 ¼ θ d þ k5 e_ 5 a2 θ_ ψ_ þ a4 θΩ
_ r (21)
b2
1
U4 ¼ ψ€ d þ k7 e_ 7 a5 φ_ θ_ (22)
b3
The feedback linearization method is used in order to decouple the state vari-
ables of the quadcopter. This will enable us to derive the LQ-based control laws for
the attitude, altitude, and position of the quadcopter.
Y3 ¼ z (25)
cφ:cθ
Y€ 3 ¼ z€ ¼ U1 g (26)
m
m
U1 ¼ ðV 1 þ gÞ (27)
cφ:cθ
9
Unmanned Robotic Systems and Applications
where V1 is a virtual input, which is computed using LQI controller that will be
presented in section 4.2.4.
Ixx
U2 ¼ a1 θ_ ψ_ a2 Ωr θ_ þ V 2 (28)
l
Iyy
U 3 ¼ f a3 φ_ ψ_ þ a4 Ωr φ_ þ V 3 g (29)
l
Izz
U4 ¼ a5 φ_ θ_ þ V 4 (30)
l
The previous control laws linearize the mapping between the derivatives of the
flat outputs Y 4 ¼ φ, Y 5 ¼ θ, Y 6 ¼ ψ, and the virtual controls V2, V3, V4. The latter
are again computed using an LQI optimal controller,
ðIyy Izz Þ
where a1 ¼ Ixx , a2 ¼ IJxxr , a3 ¼ ðIzzIyyIxx Þ, a4 ¼ IJyyr , and a5 ¼ ðIzzIyyIxx Þ.
Here, ϕ and θ angles are computed by the control laws of x and y motion, as it is
done in the integral backstepping approach. The control laws are obtained as follows:
o
m n sφ:sψ
θd ¼ arcsin v_ xd U1 þ V 5 (31)
cφ:cθ:U 1 m
m cφ:sθ:sψ
φd ¼ arcsin v_ yd U1 þ V 6 (32)
cψ:U 1 m
where V5 and V6 are the proposed linear quadratic integral optimal controller.
The goal of the optimal control is to determine the control feedback, for which
the optimal controller minimizes a proposed cost function J to desired minimum
value. The cost function of the linear quadratic regulator is given as follows [32]:
∞
ð
xT Q x þ uT R u dt
J¼ (33)
0
where Q and R represent the weighting matrices for the state vector x and
control law vector u, respectively. LQR is conveniently applied to linear control
systems or linearized nonlinear control systems. The state space model of a linear
control system is given as follows:
x_ ¼ Ax þ Bu
(34)
y ¼ Cx þ Du
The control law u, which minimizes the cost function J, can be derived as
follows:
10
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
u¼ Kx¼ R 1 BT P x (35)
where P is a covariance matrix. It is the solution of the algebraic Riccati Eq. (36),
in which P_ ¼ 0
AT P þ PA PBR 1 BT P þ Q ¼ P_ (36)
LQR controller is capable to provide a high dynamic performance when used with
linear or linearized control systems. However, LQR is not capable to ensure fast track-
ing of time varying command signals [33, 34]. Different types of LQRs are demon-
strated in literatures [32]. Figure 3 shows an LQI regulator, with an integral action.
If the model of the linear system is extended by an error vector z_ such as
where r is a reference signal, which may represent the desired trajectory for
tracking. The extended state space model of the LQI regulator is as follows:
" #
x_ A 0 x B 0 u
¼ þ (38)
z_ C 0 z D I r
u¼ Kx KI z (39)
In order to obtain the attitude and position control laws of the quadcopter using
sliding mode control, the steps followed are discussed below.
In order to obtain the control laws of the quadcopter using sliding mode control,
at first, the sliding surface should be determined as follows:
s1 ¼ c1 e1 þ e_ 1 (40)
Figure 3.
LQI optimal controller structure.
11
Unmanned Robotic Systems and Applications
From the equation of motion, the second derivative of the error becomes
cφcθ
e€1 ¼ z€d z€ ¼ z€d U1 þ g (42)
m
cφcθ
s_1 ¼ z€d U 1 þ g þ c1 ðz_ d z_ Þ ¼ 0 (43)
m
cφcθ
K 1 s1 Q 1 sgn ðs1 Þ ¼ z€d U 1 þ g þ c1 ðz_ d z_ Þ (44)
m
m
U1 ¼ fz€d þ g þ c1 ðz_ d z_ Þ þ K 1 s1 þ Q 1 sgn ðs1 Þg (45)
cφcθ
By following sliding mode control steps of design for the attitude of the
quadcopter, we obtain
1
U2 ¼ φ€ a1 θ_ ψ_ _ r þ c2 ðφ_ d
a2 θΩ φ_ Þ þ K 2 s2 þ Q 2 : sgn ðs2 Þ (46)
b1 d
1 €
a2 θ_ ψ_ þ a4 θΩ
_ r þ c3 θ_ d θ_ þ K 3 s3 þ Q 3 : sgn ðs3 Þ
U3 ¼ θd (47)
b2
1
U4 ¼ ψ€ d a5 φ_ θ_ þ c4 ðψ_ d ψ_ Þ þ K 4 s4 þ Q 4 : sgn ðs4 Þ (48)
with b3
s2 ¼ c2 e2 þ e_ 2 s3 ¼ c3 e3 þ e_ 3 s4 ¼ c4 e4 þ e_ 4
e2 ¼ φd φ e3 ¼ θ d θ e4 ¼ ψ d ψ
Same strategy will be followed to derive the control laws of the position as in
integral backstepping and feedback linearization. The control laws of both x, y will
command the attitude loop with the references to accomplish the desired trajectory
o
m n sφ:sψ
θd ¼ arcsin x€d U 1 þ K 5 s5 þ Q 5 : sgn ðs5 Þ (49)
cφ:cθ:U 1 m
m cφ:sθ:sψ
φd ¼ arcsin y€ U 1 þ K 6 s6 þ Q 6 : sgn ðs6 Þ (50)
cψ:U 1 d m
with
s5 ¼ c5 e5 þ e_ 5 s6 ¼ c6 e6 þ e_ 6
e5 ¼ xd x e 6 ¼ yd y
12
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
4.4 Results
Figure 4.
Desired and actual trajectory, proposed integral backstepping response (4-a), feedback linearization with LQI
response (4-b), and sliding mode control response (4-c).
Figure 5.
Desired and actual trajectory, proposed integral backstepping response (5-a), feedback linearization with LQI
response (5-b), and sliding mode control response (5-c).
13
Unmanned Robotic Systems and Applications
Figure 6.
Trajectory tracking errors, proposed integral backstepping response (6-a), feedback linearization with LQI
response (6-b), and sliding mode control response (6-c).
Figure 7.
Practical UAV control scheme.
Figure 8.
Pitch practical response using integral backstepping.
14
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
Figure 9.
Pitch practical response: (a) using integral backstepping and (b) feedback linearization with LQI.
quadcopter motion on x, y and z. However, as seen, the tracking error of the motion
on the three axes converged to zero. But, a little divergence was observed, which
were due to the existence of disturbance with the command signals.
The practical implementation, of the proposed control strategies of the attitude
control of the quadcopter, has been validated using Arduino MEGA board with an
inertial measurement unit (IMU). Figure 7 exhibits the practical UAV control
system. Figure 8 shows the practical implementation results and response of pitch
angle using integral backstepping controller. As noticed earlier, there is a static error
with oscillating response. Figure 9a and b demonstrates the practical result and
response of the roll angle when implementing integral backstepping and feedback
linearization with LQI controllers, respectively.
As noticed from Figure 9a, there was an oscillating response for pitch angle
control during transient state, of almost undesired of 20° of overshoot and
downshoot when implementing the proposed backstepping controller. But, high
dynamic performance and fast tracking control were obtained for pitch angle con-
trol when implementing the proposed LQI controller with feedback linearization
approach as seen in Figure 9b.
5. Conclusion
This chapter has discussed different advanced control techniques for UAV con-
trol. Nonlinear control theories have been reviewed among other control strategies
due to their capacity to deal with the nonlinearity and the coupling components of
the UAV state variables. This includes backstepping, feedback linearization, and
sliding mode control. UAV nonlinear model has been derived and modeled in
MATLAB®, and the proposed control strategies have been implemented. Simulation
results obtained from the developed model with the control strategies were
presented and discussed. Different path tracking and trajectories have been
examined with successful and high dynamic performance. The developed control
strategies have exhibited robustness against the UAV parameter mismatch and
dynamic uncertainties.
15
Unmanned Robotic Systems and Applications
Author details
© 2019 The Author(s). Licensee IntechOpen. This chapter is distributed under the terms
of the Creative Commons Attribution License (http://creativecommons.org/licenses/
by/3.0), which permits unrestricted use, distribution, and reproduction in any medium,
provided the original work is properly cited.
16
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
References
[8] Ali Q , Montenegro S. Explicit model [15] Hwang CL. Hybrid neural network
following distributed control scheme for under-actuated sliding mode control for
17
Unmanned Robotic Systems and Applications
18
Advanced UAVs Nonlinear Control Systems and Applications
DOI: http://dx.doi.org/10.5772/intechopen.86353
19