Professional Documents
Culture Documents
Design of Sliding Mode Controllers For Quadrotor Vehicles Via Flatness-Based Feedback and Feedforward Linearization Strategies
Design of Sliding Mode Controllers For Quadrotor Vehicles Via Flatness-Based Feedback and Feedforward Linearization Strategies
Design of Sliding Mode Controllers For Quadrotor Vehicles Via Flatness-Based Feedback and Feedforward Linearization Strategies
Abstract— Unmanned Aerial Vehicles (UAVs) have to operate disturbances, thus motivating the adoption of robust control
in complex environments, characterized by disturbances of strategies.
different nature that affect the system performance. Moreover, In this context, SMC plays a crucial role, thanks to the
system dynamics can be altered by unavoidable modeling un-
certainties, that can further decrease the control performance. robustness features enabled on controlled systems character-
This motivates the introduction of robust control strategies ized by hard nonlinearities and uncertainties [2]. In particular,
and, among them, Sliding Mode Control (SMC) represents SMC algorithms are suitable to cope with uncertainties and
a viable solution, provided that the UAV model is led back disturbances of matched type, i.e., acting on the same channel
to a normal form, suitable for control design purposes. This of the control input. Furthermore, using a discontinuous
paper investigates two flatness-based linearization approaches,
a feedback and a feedforward one, that transform the nonlinear control signal allows to achieve finite time convergence of
and coupled quadrotor model into a canonical form eligible the controlled variable, i.e., the so-called sliding variable,
to design a trajectory tracking controller based on a battery thus speeding up the tracking performance of the controlled
of Higher-Order Sliding Mode (HOSM) regulators. Simulation system, in spite of the unknown terms. However, in order
results, based on a realistic model of a quadrotor, are presented to formulate the control problem in an appropriate way,
to assess the performance of the proposed control system.
it is convenient to make reference to a canonical form
I. I NTRODUCTION frequently used in SMC theory. This diffeomorphism is not
In the last decade, UAV flight control has represented a only instrumental to ease the solution of the control problem,
deeply and extensively researched topic. These vehicles have as it allows to regulate a perturbed chain of integrators
indeed changed many different application domains, ranging instead of a highly nonlinear model, but supports the design
from entertainment to border surveillance monitoring and of efficient kinodynamic planning algorithms, as well.
inspection of industrial plants [1], thanks to their capabil- This paper, inspired by [3], proposes and compares two
ity to collect many information through on-board sensors, flatness-based linearization approaches, one relying on a
and to manipulate the working environment via their tools. feedback and another one on a feedforward control law,
Furthermore, as on-board pilots are not needed, and UAVs that transform a nonlinear and coupled dynamical system
mobility and agility are superior with respect to their piloted into a canonical form eligible to design a trajectory tracking
counterparts, they are suitable candidates for autonomous controller based on a battery of HOSM regulators.
applications in hazardous environments or in any situation Many works have been published in the literature on
in which human intervention is significantly dangerous. the design of flight controllers for UAVs. In [4], for in-
Quadrotor vehicles are a class of UAVs characterized by a stance, the control design is performed using linear control
symmetric body frame and four propellers located at the end tools, linearizing the quadrotor model around the hovering
of the frame arms. They can be modeled as a six degrees of equilibrium point. Nonlinear control techniques, including
freedom mechanical system, composed of three translational fuzzy logic [5], flatness-based passivity control [6], and
and three rotational motions, and characterized by four adaptive controllers, even of sliding mode type [7], are in-
inputs, typically represented by propeller rotational speeds. stead proposed in [8]. More precisely, as for HOSM control,
As a consequence, a UAV is an underactuated system, recent contributions can be found in [9] and [10], respec-
which makes the flight control problem more challenging. tively. Moreover, flatness-based feedforward and feedback
A common practice to overcome this issue is by taking into linearization schemes, in combination with model predictive
account only three translational and one rotational degrees controllers, have also been proposed, e.g., in [3], [11].
of freedom, so that the number of control signals equals Although SMCs are capable of being insensitive to a
that of controlled variables, but all the motions are coupled widely class of uncertainties, often independently of system
and characterized by highly nonlinear dynamics. In addition, nonlinearities (see, e.g., [2, Chapter 1] for further details), a
this dynamics is unavoidably affected by parametric uncer- global linearization turns out to be very effective. This moti-
tainties, due to modeling simplifications, and by external vates the present paper, that formulates a general procedure
for SMC design based on differential flatness theory [12].
L. Bascetta and G. P. Incremona are with the Dipartimento di Elet-
tronica, Informazione e Bioingegneria, Politecnico di Milano, Piazza The application of this tool allows to define a bidirectional
Leonardo da Vinci 32, 20133 Milan, Italy (e-mail: {luca.bascetta, coordinate transformation that gives rise to an equivalent
gianpaolo.incremona}@polimi.it). The work of G. P. In- linear system in normal canonical form, perfectly fitting the
cremona has been partially supported by the Italian Ministry for Research
in the framework of the 2017 Program for Research Projects of National requirements to design a trajectory tracking controller based
Interest (PRIN), Grant no. 2017YKXYXJ. on SMC theory.
ψ = σ4
cθ 0 −cφ sθ φ̇ (4)
ω = 0 1 sφ θ̇ , m W 1,2 (3) W 2,2 (3) W 3,2 (3)
p=− RB σ1 + RB σ2 + RB σ3
sθ 0 cφ cθ ψ̇ u
1
m W 1,1 (3) W 2,1 (3) W 3,1 (3)
q= RB σ 1 + RB σ 2 + RB σ 3
with the notation c(·) , cos(·) and s(·) , sin(·). Moreover, u1
the skew-symmetric matrix S (ω), representing the rotational r = tθ (p + cφ sθ σ̇4 ) + cφ cθ σ̇4 ,
1623
Authorized licensed use limited to: Politecnico di Milano. Downloaded on October 10,2023 at 09:06:47 UTC from IEEE Xplore. Restrictions apply.
ξ̈=fξ (z,v) so that a dependence on virtual input explicitly appears [12],
v u1 ,u2 χ
u1 =ξ [15], obtaining
u2 =fu2 (z,v) " 2 #
m > > α> β
z ü1 = √ α γ+β β− ,
χ→z α> α α> α
> h i>
with α = σ̈1 σ̈2 σ̈3 + g , β = σ1(3) σ2(3) σ3(3) ,
Fig. 2. Feedback linearizing controller.
h i>
v
γ = σ1(4) σ2(4) σ3(4) . Now, let zj , j = 1, . . . , 14,
ξ̈=fξ (z,v)
u1 =ξ
u1 ,u2 χ be the variables associated to the elements of vector z,
z and vi , i = 1, . . . , 4, those associated to vector v. Using
u2 =fu2 (z,v)
the previous expression, provided that α 6= 0 to avoid
singularities, suitably introducing an intermediate variable ξ,
Fig. 3. Feedforward linearizing controller.
and substituting flat outputs with the corresponding elements
of state vector z, together with relation (6), the following
linearizing law can be defined
where W Ri,jB represents element (i, j) of
W
RB matrix, and
(k) 2
σi is the k-th derivative of variable σi with respect to time.
T
m T α̃ β̃
As for the inputs, model (1) and relations (3)-(4) allow to ξ¨ = √ α̃ γ̃ + β̃ T β̃ −
α̃T α̃
directly derive the following mapping α̃T α̃
q
u1 = m σ̈12 + σ̈22 + (σ̈3 + g)2 (5) u1 = ξ (7)
p̃˙
0 −r̃ q̃ p̃
and
ṗ 0 −r q
p u2 = I q̃˙ + r̃
0 −p̃ I q̃ ,
u2 = I q̇ + r 0 −p I q , (6) r̃˙ −q̃ p̃ 0 r̃
ṙ −q p 0 r where tilde operator applied to a variable means that it is
where ṗ, q̇, ṙ can be related to flat outputs differentiating calculated substituting the highest order derivatives of flat
with respect to time the mapping that gives p, q, and r, outputs with the corresponding component of v, and the re-
respectively. maining flat
outputs with the>corresponding
> of z,
component
According to [12], [14], every differentially flat nonlinear i.e., α̃ = z3 z7 z11 + g , β̃ = z4 z8 z12 , γ̃ =
>
system can be transformed into an equivalent linear one in v1 v2 v3 . Finally, relation (7) represents a feedback or
Brunovsky canonical form, defining a suitable state vector z, feedforward linearizing law, depending on how state vector
based on flat outputs, a virtual input vector v corresponding z is interpreted. If z is substituted with a measurement of the
to the highest order derivatives of flat outputs, and exploiting quadrotor state, a loop is closed and equation (7) represents
the flat mapping. a feedback linearizing law (Figure 2). If z is instead sub-
A closer inspection to mappings (3), (4), (5), and (6) re- stituted with the nominal behavior of the state, equation (7)
veals that, in the case of a quadrotor, the highest order represents a feedforward linearizing law (Figure 3). In both
(3)
derivatives are: σi , i = 1, 2, 3, and σ̇4 for the state cases, the application of (7) to model (1) transforms it into
(4) a dynamical system in Brunovsky canonical form, i.e.,
mapping, and σi , i = 1, 2, 3, and σ̈4 for the input mapping.
Consequently, virtual input vector v has to be selected as żj (t) = zj+1 , j = 1, . . . ρi − 1
h i >
v , σ1(4) σ2(4) σ3(4) σ̈4 , and state vector z as z , (8)
h i żρi (t) = vi + δi ,
>
z1 z2 z3 z4 , where zi = σi σ̇i σ̈i σi(3) , i =
where δi ∈ D ⊂ R represents the lumped uncertainty due to
1, 2, 3, and z4 = σ4 σ̇4 . modeling mismatch or to disturbances du1 and du2 , while
In the following, two control laws to transform model (1) the relative degree is ρi = 4, for i = 1, 2, 3, and ρ4 = 2.
in Brunovsky canonical form are introduced, one based on a
feedback and another one on a feedforward control action. IV. D ESIGN OF THE HOSM C ONTROLLERS
We are now in a position to introduce the adopted sliding
B. Feedback and Feedforward linearization mode controllers. First, the sliding surfaces are defined, then
According to [12], [14]–[16], a linearizing law can be HOSM control laws [17] of suitable order are proposed.
derived from the input mapping substituting the highest order
derivatives of flat outputs with the corresponding elements A. Sliding surfaces
of virtual input vector v, and the remaining flat outputs with The linearization approaches discussed in the previous
the corresponding elements of state vector z. section allow to reduce model (1) to a dynamical system
Considering that relation (5) does not depend on virtual in normal form. More specifically, the linearized quadrotor
inputs, it has to be differentiated twice with respect to time dynamics is captured by the chain of three 4-order integrators
1624
Authorized licensed use limited to: Politecnico di Milano. Downloaded on October 10,2023 at 09:06:47 UTC from IEEE Xplore. Restrictions apply.
and a double integrator, given in (8). This system is hence A. Settings
eligible to be controlled via HOSM control laws. For the sake of validation a nonlinear model of the quadro-
The so-called sliding variables, namely si (z) ∈ R, i = tor, exploiting motion equations (1), has been implemented
1, . . . , 4 are chosen as the error between the flat measured in M ATLAB -S IMULINK© . The main physical parameters are
state z and the reference state z? , i.e., si (z) = z(4i−3) − reported in Table I. Note that, according to modeling assump-
? (k)
z(4i−3) , i = 1, . . . , 4. Letting ζik+1 , si , k ∈ N≥0 be new tion 4, the dynamics of the actuators has been neglected in
auxiliary states, the corresponding auxiliary systems are the simulator as well, as it is at least an order of magnitude
faster than quadrotor dynamics.
ζ̇ij (t) = ζij+1 , j = 1, . . . ρi − 1
?(4)
(9) TABLE I
ζ̇iρi (t) = vi − z(4i−3) + δi .
QUADROTOR PARAMETERS
In this section, the two proposed linearization techniques, where the amplitudes are equal to Du1 = 1.4 N, Du2 =
together with the proposed battery of HOSM controllers, are 1.41 N m, and have been selected in order to have a distur-
validated in simulation. bance around 20 % of the observed maximum input values.
1625
Authorized licensed use limited to: Politecnico di Milano. Downloaded on October 10,2023 at 09:06:47 UTC from IEEE Xplore. Restrictions apply.
(a) trajectory (b) tracking error (c) control signal
Fig. 4. Helical trajectory (reference as gray dashed line, actual as black line) using feedback linearization.
Fig. 5. Helical trajectory (reference as gray dashed line, actual as black line) using feedforward linearization.
1626
Authorized licensed use limited to: Politecnico di Milano. Downloaded on October 10,2023 at 09:06:47 UTC from IEEE Xplore. Restrictions apply.
TABLE II
[2] A. Ferrara, G. P. Incremona, and M. Cucuzzella, Advanced and
ISE INDEXES IN NOMINAL (N) AND PERTURBED (P) CONDITIONS Optimization Based Sliding Mode Control: Theory and Applications.
Philadelphia, PA: Society for Industrial and Applied Mathematics,
N P 2019.
[3] M. Greeff and A. P. Schoellig, “Flatness-based model predictive
x 2.46 × 10−13 1.21 control for quadrotor trajectory tracking,” in International Conference
FB y 3.41 × 10−6 1.16 × 10−4 on Intelligent Robots and Systems, Madrid, Spain, 2018, pp. 6740–
z 2.06 × 10−14 2.66 6745.
ψ 8.12 × 10−6 8.38 × 10−4
[4] I. D. Cowling, O. A. Yakimenko, J. F. Whidborne, and A. K. Cooke,
x 1.82 × 10−13 0.82 “A prototype of an autonomous controller for a quadrotor UAV,” in
FF y 2.78 × 10−6 8.59 × 10−5 European Control Conference (ECC), Kos, Greece, 2007, pp. 4001–
z 2.10 × 10−14 2.74 4008.
ψ 1.24 × 10−6 7.58 × 10−6 [5] B. E. Demir, R. Bayir, and F. Duran, “Real-time trajectory tracking
of an unmanned aerial vehicle using a self-tuning fuzzy proportional
integral derivative controller,” International Journal of Micro Air
TABLE III
Vehicles, vol. 8, no. 4, pp. 252–268, 2016.
ISI INDEXES IN NOMINAL (N) AND PERTURBED (P) CONDITIONS [6] S. Formentin and M. Lovera, “Flatness-based control of a quadrotor
helicopter via feedforward linearization,” in IEEE Conference on
N P
Decision and Control, Orlando, Florida, USA, 12 2011, pp. 6171–
6176.
FB 1223.06 1243.28 [7] H. Castañeda and J. Gordillo, “Embedded flight control based on
FF 1223.09 1238.20 adaptive sliding mode strategy for a quadrotor micro air vehicle,”
Electronics, vol. 8, no. 7, pp. 1–15, 2019.
[8] P. Lu, E. van Kampen, and Q. Chu, “Nonlinear quadrotor control with
online model identification,” in Advances in Aerospace Guidance, Nav-
igation and Control, J. Bordeneuve-Guibé, A. Drouin, and C. Roos,
seconds, in order to avoid the effects of the discontinuities Eds. Cham: Springer, 2015, pp. 381–98.
introduced by the take off step and by the transition from [9] H. Rı́os, R. Falcón, O. A. González, and A. Dzul, “Continuous sliding-
the step to the helix. mode control strategies for quadrotor robust tracking: Real-time appli-
cation,” IEEE Transactions on Industrial Electronics, vol. 66, no. 2,
We can observe that in nominal conditions feedforward pp. 1264–1272, 2019.
and feedback linearization give rise to equivalent results, [10] A. Ferreira de Loza, L. Fridman, L. T. Aguilar, and R. Iriarte,
but in the presence of parametric uncertainty and input “High-order sliding-mode observer–based input-output linearization,”
International Journal of Robust and Nonlinear Control, vol. 29, no. 10,
disturbances feedforward linearization outperforms. Indeed, pp. 3183–3199, 2019.
although the input disturbances and parametric uncertainty [11] D. Falanga, P. Foehn, P. Lu, and D. Scaramuzza, “PAMPC: Perception-
are present, ISE takes rather small values. Concerning the Aware Model Predictive Control for quadrotors,” in IEEE/RSJ Interna-
tional Conference on Intelligent c Robots and Systems (IROS), Madrid,
control signal, we observe that feedback and feedforward Spain, 2018, pp. 1–8.
linearization give rise to a similar control effort. In particular, [12] M. Fliess, J. Lévine, P. Martin, and P. Rouchon, “A Lie-Backlund
it is noteworthy that the increase in the ISI due to input approach to equivalence and flatness of nonlinear systems,” IEEE
Transaction on Automatic Control, vol. 44, pp. 922–937, 1999.
disturbances and parametric uncertainty is less than 2 % [13] M. M. Pekkaptan, “Higher order sliding mode control of a flatness-
with respect to nominal conditions. based feedforward/feedback linearized quadrotor,” Master’s thesis,
Politecnico di Milano, 2020.
[14] V. Hagenmeyer and E. Delaleau, “Exact feedforward linearization
VI. C ONCLUSIONS based on differential flatness,” International Journal of Control,
vol. 76, pp. 537–556, 04 2003.
In this paper, two flatness-based linearization approaches [15] M. Van Nieuwstadt, M. Rathinam, and R. M. Murray, “Differential
are investigated, aiming at suitably design robust controllers flatness and absolute equivalence of nonlinear control systems,” SIAM
Journal of Control and Optimization, vol. 36, no. 4, pp. 1225–1239,
for quadrotors. These approaches allow to transform the UAV 1998.
model into an equivalent system in Brunovsky canonical [16] V. Hagenmeyer, S. Streif, and M. Zeitz, “Flatness-based feedforward
form, which is eligible for the design of SMC systems of and feedback linearisation of the ball & plate lab experiment,” in IFAC-
Symposium on Nonlinear Control Systems, Stuttgart, Germany, 2004.
suitable order. A battery of fourth and second-order sliding [17] Y. Shtessel, C. Edwards, L. Fridman, and A. Levant, “Higher-order
mode controllers has been proposed, and simulation results sliding mode controllers and differentiators,” in Sliding Mode Control
are presented to assess robustness and performance enabled and Observation, ser. Control Engineering. Springer New York, 2014,
pp. 213–249.
by the use of the two linearization approaches. [18] A. Levant, “Higher-order sliding modes, differentiation and output-
feedback control,” International Journal of Control, vol. 76, no. 9-10,
ACKNOWLEDGMENT pp. 924–941, 2003.
The authors would like to thank the former student M. M. [19] N. Xuan-Mung and S. K. Hong, “Robust backstepping trajectory
tracking control of a quadrotor with input saturation via extended state
Pekkaptan for his valuable work on this project. observer,” Applied Sciences, vol. 9, no. 23, p. 5184, 2019.
[20] ——, “Robust adaptive formation control of quadcopters based on a
R EFERENCES leader-follower approach,” International Journal of Advanced Robotic
[1] H. Shakhatreh, A. H. Sawalmeh, A. Al-Fuqaha, Z. Dou, E. Almaita, Systems, vol. 16, no. 4, 2019.
I. Khalil, N. S. Othman, A. Khreishah, and M. Guizani, “Unmanned [21] B. J. Njinwoua and A. V. Wouwer, “Cascade attitude control of a
aerial vehicles (UAVs): A survey on civil applications and key research quadcopter in presence of motor asymmetry,” IFAC Conference on
challenges,” IEEE Access, vol. 7, pp. 48 572–48 634, 2019. Advances in Proportional-Integral-Derivative Control, vol. 51, no. 4,
pp. 113–118, 2018.
1627
Authorized licensed use limited to: Politecnico di Milano. Downloaded on October 10,2023 at 09:06:47 UTC from IEEE Xplore. Restrictions apply.