8
WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A QUADROTOR UAV Giovanni F. Salierno * , Guilherme V. Raffo *† * Graduate Program in Electrical Engineering - Federal University of Minas Gerais Av. Antˆonio Carlos 6627, 31270-901, Belo Horizonte, MG, Brazil Department of Electronic Engineering - Federal University of Minas Gerais Av. Antˆonio Carlos 6627, 31270-901, Belo Horizonte, MG, Brazil Emails: [email protected], [email protected] Abstract— This paper proposes a backstepping nonlinear control to perform time-varying trajectory tracking of a quadrotor UAV, assuming its whole six degree of freedom (6DOF) dynamics. The control law is designed with integral action of the controlled velocities’ errors, in order to guarantee convergence to the reference signals. By using the whole-body dynamic model in the backstepping approach and assuming the desired behavior of the rotation matrix as a part of a virtual control, it is obtained reference trajectory tracking and stabilization of rotational movements, avoiding singularities in the translational control. The stability analysis is performed for the complete system through the Lyapunov Theory. Simulations are carried out to corroborate the efficiency of the proposed controller when tracking a time-varying trajectory of the regulated variables (x, y, z and ψ). Keywords— Quadrotor UAV, Backstepping approach, Integral action, Nonlinear control. Resumo— Este trabalho prop˜oe um controle n˜ ao linear backstepping para realizar rastreamento de trajet´oria variante no tempo para um VANT quadrotor, assumindo sua dinˆ amica completa com seis graus de liberdade (6DOF). A lei de controle ´ e projetada com a¸ c˜ao integral dos erros das velocidades controladas, com o objetivo de garantir convergˆ encia para os sinais de referˆ encia. Usando o modelo dinˆamico de corpo completo na abordagem backstepping e assumindo o comportamento desejado da matriz de rota¸c˜ao como parte de um controle virtual, ´ e obtido o rastreamento da trajet´oria de referˆ encia e estabiliza¸c˜ao dos movimentos rotacionais, evitando singu- laridades no controle de transla¸ c˜ao. A an´alise de estabilidade ´ e realizada para o sistema completo atrav´ es da Teoria de Lyapunov. S˜ao realizadas simula¸ c˜oes para corroborar a eficiˆ encia do controlador proposto ao rastrear trajet´orias variantes no tempo das variv´ aveis reguladas (x, y, z e ψ). Palavras-chave— VANT Quadrotor, Abordagem Backstepping, A¸c˜ao integral, Controle n˜ao linear. 1 Introduction In the last years, the use of unmanned aerial vehicles (UAVs) in industry has increased com- mercial potential with several civilian and mil- itary applications, including search and rescue, border surveillance, inspections, among others (Bouabdallah et al., 2004; Bouabdallah and Sieg- wart, 2005; Serra et al., 2016; Tan et al., 2016). Quadrotor aircrafts constitute a particular kind of helicopters, known as multicopters, that possess many advantages over traditional ones, when analyzed in terms of safety and efficiency at small sizes. Several research groups have begun constructing quadrotor UAVs as robotics research tools (Hamel et al., 2002; Huang et al., 2009). In order to control UAVs, many works in the literature are found using backstepping technique. Backstepping control method is a technique for cascade structures, that achieves stability through the design of control Lyapunov functions. In Rap- tis et al. (2011) a backstepping controller is de- signed for a helicopter in SE(3), from which the overall helicopter dynamics are stabilized while tracking a time-varying translational trajectory with fixed yaw angle. Mahony and Hamel (2004) proposed a backstepping control design for trajec- tory tracking of a helicopter considering bounds on initial error and trajectory parameters. Despite of the great amount of control strate- gies designed for quadrotor UAVs, it remains a subject of researches in order to improve flight performance. For controlling this UAV configu- ration, backstepping control technique is also one of the most used. However, this is usually ap- plied to perform the path tracking and stabiliza- tion problems separately, which can lead to sta- bility issues of the whole system. In Tan et al. (2016), null steady-state error is achieved in the quadrotor planar target tracking without integral action. The backstepping approach was designed using contraction theory, in which the altitude dy- namics are separated from the planar ones. On the other hand, integral action can also be added in the backstepping formulation to en- sure null steady-state error in presence of para- metric uncertainties, external disturbance and un- modeled dynamics. In Bouabdallah and Siegwart (2007), the integral action is added in the first step of error dynamics for the backstepping con- trol design of a quadrotor, assuming time-constant orientation references. Mian and Daobo (2008) in- cluded an integral action in the roll angle position error, also in the first step of the backstepping. Jasim and Gu (2015) controlled translational path tracking of a quadrotor using backstepping with integral action in the first step control. In Raffo et al. (2015), a robust nonlinear control strat- XIII Simp´osio Brasileiro de Automa¸ ao Inteligente Porto Alegre – RS, 1 o – 4 de Outubro de 2017 ISSN 2175 8905 2157

WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

  • Upload
    others

  • View
    1

  • Download
    0

Embed Size (px)

Citation preview

Page 1: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF AQUADROTOR UAV

Giovanni F. Salierno∗, Guilherme V. Raffo∗†

∗Graduate Program in Electrical Engineering - Federal University of Minas GeraisAv. Antonio Carlos 6627, 31270-901, Belo Horizonte, MG, Brazil

†Department of Electronic Engineering - Federal University of Minas GeraisAv. Antonio Carlos 6627, 31270-901, Belo Horizonte, MG, Brazil

Emails: [email protected], [email protected]

Abstract— This paper proposes a backstepping nonlinear control to perform time-varying trajectory trackingof a quadrotor UAV, assuming its whole six degree of freedom (6DOF) dynamics. The control law is designedwith integral action of the controlled velocities’ errors, in order to guarantee convergence to the reference signals.By using the whole-body dynamic model in the backstepping approach and assuming the desired behavior ofthe rotation matrix as a part of a virtual control, it is obtained reference trajectory tracking and stabilization ofrotational movements, avoiding singularities in the translational control. The stability analysis is performed forthe complete system through the Lyapunov Theory. Simulations are carried out to corroborate the efficiency ofthe proposed controller when tracking a time-varying trajectory of the regulated variables (x, y, z and ψ).

Keywords— Quadrotor UAV, Backstepping approach, Integral action, Nonlinear control.

Resumo— Este trabalho propoe um controle nao linear backstepping para realizar rastreamento de trajetoriavariante no tempo para um VANT quadrotor, assumindo sua dinamica completa com seis graus de liberdade(6DOF). A lei de controle e projetada com acao integral dos erros das velocidades controladas, com o objetivo degarantir convergencia para os sinais de referencia. Usando o modelo dinamico de corpo completo na abordagembackstepping e assumindo o comportamento desejado da matriz de rotacao como parte de um controle virtual,e obtido o rastreamento da trajetoria de referencia e estabilizacao dos movimentos rotacionais, evitando singu-laridades no controle de translacao. A analise de estabilidade e realizada para o sistema completo atraves daTeoria de Lyapunov. Sao realizadas simulacoes para corroborar a eficiencia do controlador proposto ao rastreartrajetorias variantes no tempo das varivaveis reguladas (x, y, z e ψ).

Palavras-chave— VANT Quadrotor, Abordagem Backstepping, Acao integral, Controle nao linear.

1 Introduction

In the last years, the use of unmanned aerialvehicles (UAVs) in industry has increased com-mercial potential with several civilian and mil-itary applications, including search and rescue,border surveillance, inspections, among others(Bouabdallah et al., 2004; Bouabdallah and Sieg-wart, 2005; Serra et al., 2016; Tan et al., 2016).

Quadrotor aircrafts constitute a particularkind of helicopters, known as multicopters, thatpossess many advantages over traditional ones,when analyzed in terms of safety and efficiency atsmall sizes. Several research groups have begunconstructing quadrotor UAVs as robotics researchtools (Hamel et al., 2002; Huang et al., 2009).

In order to control UAVs, many works in theliterature are found using backstepping technique.Backstepping control method is a technique forcascade structures, that achieves stability throughthe design of control Lyapunov functions. In Rap-tis et al. (2011) a backstepping controller is de-signed for a helicopter in SE(3), from which theoverall helicopter dynamics are stabilized whiletracking a time-varying translational trajectorywith fixed yaw angle. Mahony and Hamel (2004)proposed a backstepping control design for trajec-tory tracking of a helicopter considering boundson initial error and trajectory parameters.

Despite of the great amount of control strate-gies designed for quadrotor UAVs, it remains asubject of researches in order to improve flightperformance. For controlling this UAV configu-ration, backstepping control technique is also oneof the most used. However, this is usually ap-plied to perform the path tracking and stabiliza-tion problems separately, which can lead to sta-bility issues of the whole system. In Tan et al.(2016), null steady-state error is achieved in thequadrotor planar target tracking without integralaction. The backstepping approach was designedusing contraction theory, in which the altitude dy-namics are separated from the planar ones.

On the other hand, integral action can alsobe added in the backstepping formulation to en-sure null steady-state error in presence of para-metric uncertainties, external disturbance and un-modeled dynamics. In Bouabdallah and Siegwart(2007), the integral action is added in the firststep of error dynamics for the backstepping con-trol design of a quadrotor, assuming time-constantorientation references. Mian and Daobo (2008) in-cluded an integral action in the roll angle positionerror, also in the first step of the backstepping.Jasim and Gu (2015) controlled translational pathtracking of a quadrotor using backstepping withintegral action in the first step control. In Raffoet al. (2015), a robust nonlinear control strat-

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

ISSN 2175 8905 2157

Page 2: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

egy is proposed for quadrotor path tracking. Abackstepping control design with integral action inthe second step is designed to track translationalmovements, while a nonlinear H∞ controller sta-bilizes the rotational movements. Adding the in-tegral action in the second step means that it isintegrating the velocity dynamics, while the firststep is about the position dynamics.

Skjetne and Fossen (2004) showed that for ageneric plant, adding integral action in the firststep of the backstepping control design guaran-tees convergence for constant reference signals,but could not be guaranteed when the referencesignal is time-varying. However, by adding it inthe second step the convergence is achieved forboth constant and time-varying signals.

The goal of this work is to design a backstep-ping nonlinear control to perform trajectory track-ing of a quadrotor UAV, assuming its whole sixdegree of freedom (6DOF) dynamics. The con-trol law is designed with integral action of thecontrolled velocities’ errors, in order to guaran-tee convergence to the reference signals. By usingthe whole-body dynamic model in the backstep-ping approach and assuming the desired behaviorof the rotation matrix as a part of a virtual con-trol, it is obtained reference trajectory trackingand stabilization of rotational movements, avoid-ing singularities in the translational control.

2 System Modeling

The quadrotor UAV is assumed as a rigid-body vehicle with a frame linked to it, representedby B = {B1, B2, B3}, and the inertial frame fixedto the Earth, represented by I = {I1, I2, I3}. Theposition of the mass center in the inertial frameis given by ξ = [x y z]′ ∈ R3. The Euler an-gles, η = [φ θ ψ]′ ∈ R3, represent the quadrotororientation in the Euclidean space respect to thefixed frame B, and R ∈ SO(3) is the rotationmatrix. Figure 1 illustrates the quadrotor’s coor-dinate frames.

ψ

φ

θ

B1

B2

B3

B

xy

z

I

Figure 1: Quadrotor coordinate system

It has a configuration with four independentrotors, each one with an electrical motor, operat-ing in two pairs spinning in opposite directions.

The roll motion tilts the quadrotor in left andright, by increasing up the speed of rotors on oneside and slowing them down on the other. In thesame manner, the pitch motion tilts the quadrotorforward and backward. The yaw movement is de-fined in such way the forward side of the quadrotorrotates towards left or right. The dynamics of thequadrotor are defined as follows (Raffo, 2011)

ξ = v, (1)

v = −ge3 +1

mRe3T +

1

mTdist, (2)

R = RS(ω), (3)

Iω = −ω × Iω + τa + τdist, (4)

where v is the velocity of mass center w.r.t. I,m is the total mass of the aircraft, g is the grav-ity acceleration, I is the inertia tensor, Tdist andτdist represent the disturbances actuating on thesystem, τa = [τφ τθ τψ]T is the vector of torquecontrol inputs, the total thrust T is the input vec-tor of the translational motion, and e3 term is thecolumn vector [0 0 1]T . The vector of angularvelocities of the body w.r.t I, expressed in B, isdefined by ω =

[p q r

]T, and S(ω) is the skew

symmetric matrix (Spong et al., 2006).The rotation matrix is given by:

R =

CψCθ CψSθSφ− SψCφ CψSθCφ+ SψSφSψCθ SψSθSφ+ CψCφ SψSθCφ− CψSφ−Sθ CθSφ CθCφ

,(5)

where C{.} = cos{.} and S{.} = sin{.}.The relationship between the time-derivative

of Euler angles and the angular rates of the body-fixed frame is:

w = Wη η, (6)

where

Wη =

1 0 −Sθ0 Cφ SφCθ0 −Sφ CφCθ

. (7)

3 Integral Backstepping Control Design

This section presents a backstepping con-troller with integral action in order to solvethe path tracking problem for the quadrotorUAV. The proposed control strategy extends thebackstepping approach presented in Mahony andHamel (2004) and Raptis et al. (2011), formulatedfor standard helicopters, to the quadrotor UAV in-cluding the integral action on the velocity errorsof the regulated variables. Therefore, the objec-tive is to design a feedback controller that manip-ulates inputs (T, τφ, τθ, τψ) in order to follow thedesired trajectories ξr(t) = [xr(t) yr(t) zr(t)]

T andψr(t), with null error for time-varying trajectoriesand constant disturbances. The backstepping con-troller is formulated as follows.

• First Step

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

2158

Page 3: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

As the first step, it is assumed the error associatedto the translational position, which is the differ-ence between the actual and the reference posi-tion, and is given by:

E1 = ξ(t) − ξr(t). (8)

The dynamics of this error are:

E1 = ξ(t) − ξr(t). (9)

From this point on, the time dependence (t)will be suppressed.

According to the backstepping standard ap-proach (Khalil, 2002), it is designed a state feed-back control law, represented by φi(α), that can

stabilize the system. In this step, it is chosen ξto be the virtual control input of the system (9),

for which (ξ)d = φ1(ξ), where d means the desired

behavior of ξ. Rewritten (9) yields:

E1 = φ1(ξ) − ξr. (10)

To guarantee the stability of the system, thefollowing control Lyapunov function is proposed:

V1(ξ) =1

2ET1 E1, (11)

and its time derivative is given by:

V1(ξ) = ET1 (φ1(ξ) − ξr). (12)

Choosing as the virtual feedback control law

φ1(ξ) = ξr − k1E1, k1 > 0, (13)

it is obtained:

V1(ξ) = ET1 (−k1E1) = −ET1 k1E1 < 0, (14)

which is negative definite. An equivalent systemcan be obtained by adding and subtracting φ1(ξ)in equation (9):

E1 = −ξr + φ1 + [ξ − φ1] = −k1E1 + [ξ − φ1]. (15)

If it is possible to guarantee that the term[ξ − φ1] converges to zero, the system (9) will beasymptotically stable. Thus, by using the changeof variable z1 = [ξ − φ1], and equations (2) and(9), the translational error dynamics are rewrittenas follows:

E1 = −k1E1 + z1,

z1 = v − ξr + k1(−k1E1 + z1). (16)

• Second Step

Evaluating the error associated to ξ−φ1, it is be-ing assessed the translational velocity error, whichis the difference between the real and the desiredvelocity. This step is developed in order to stabi-lize z1 at the origin and, consequently, achieve thetranslational position error convergence.

Moreover, at this step it is implemented theintegral term Xξ =

∫ t0z1(τ)dτ . As mentioned in

the introduction, the integral action in the sec-ond step of the backstepping approach guarantees

convergence for both constant and time-varyingreference signals.

By using equation (2), neglecting disturbanceterms, and adding the integral action, system (16)can be rewritten as:

E1 = −k1E1 + z1,

Xξ = z1,

z1 = −ge3 +1

mRe3T − ξr + k1(−k1E1 + z1). (17)

At this step, the virtual control input is cho-sen as the term that contains the rotation matrixand the total thrust (Re3T )d = φ2(R, T ). Thus,the second control Lyapunov function is chosen as:

V2(ξ, z1) = V1 +1

2zT1 z1 +

1

2X Tξ kXξXξ, kXξ > 0, (18)

and its time derivative is given by:

V2(ξ, z1) = ET1 (−k1E1 + z1) + zT1 z1 + X Tξ kXξXξ

= ET1 (−k1E1 + z1) + zT1

(−ge3 +

1

mφ2

−ξr + k1(−k1E1 + z1))

+ X Tξ kXξz1. (19)

To guarantee that V2(ξ, z1) < 0, the virtualcontrol law is designed as:

φ2(R, T ) =m(ge3 + ξr − k1(−k1E1 + z1) − E1− k2z1 − kXξXξ), k2, kXξ > 0. (20)

Replacing this control law in (19), yields:

V2(ξ, z1) = −ET1 k1E1 − zT1 k2z1 < 0, (21)

which ensures asymptotic stability of the closed-loop system (17) with (20). The system (17) canbe rewritten by adding and subtracting 1

mφ2 asfollows

E1 = − k1E1 + z1,

Xξ =z1,

z1 = − E1 − k2z1 − kXξXξ +1

m[Re3T − φ2], (22)

from which the change of variable results in z2 =[Re3T − φ2].

• Third Step

When the term z2 converges to zero, the sys-tem (22) is asymptotically stable. Therefore, atthe third step it must be guaranteed that thedifference between the real vector Re3T and thedesired one, φ2 = (Re3T )d, converges to zero.Hence, the time-derivative of z2 is computed as:

z2 =dRe3T

dt− d

φ2

dt

=Re3T +RS(w)e3T −m...ξ r +mk1E1

+mE1 +mk2z1 +mkXξz1. (23)

At this step the virtual control input is chosenas the term φ3(R, T, T , ω) = (Re3T+RS(ω)e3T )d.The third control Lyapunov function is chosen as:

V3(ξ, z1, z2) = V2 +1

2zT2 z2, (24)

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

2159

Page 4: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

and its time derivative is given by:

V3 = E1(−k1E1 + z1) + zT1

(− E1 − k2z1 +

1

mz2

− kXξXξ)

+ X Tξ kXξz1 + zT2 (φ3 −m...ξ r +mk1E1

+m(−k1E1 + z1) +mk2z1 +mkXξz1). (25)

Accordingly, now the virtual control law φ3 isshaped as:

φ3 =m...ξ r −mk1E1 −m(−k1E1 + z1) −mk2z1

−mkXξz1 −1

mz1 − k3z2, (26)

which ensures that V3 is negative definite:

V3(ξ, z1, z2) = −ET1 k1E1−zT1 k2z1−zT2 k3z2 < 0. (27)

By adding and subtracting φ3 from (23) theequivalent system is obtained:

z2 = − 1

mz1 − k3z2 + [Re3T +RS(w)e3T − φ3], (28)

in which the change of variable z3 = [Re3T +RS(w)e3T − φ3] is used.

• Fourth Step

The difference between (Re3T+RS(w)e3T )−(Re3T + RS(w)e3T )d must be null in order toachieve convergence of equation (28), which isguaranteed is this step considering:

z3 =dRe3T +RS(w)e3T

dt− d

φ3

dt

=Re3T −RS(e3)ωT +RS(ω)S(ω)e3T

+ 2RS(ω)e3T −m....ξ r +mk1

...E 1 +mE1

+mk2z1 +mkXξ z1 +1

mz1 + k3z2. (29)

The term (Re3T − RS(e3)ωT ) of equation

(29), using ω =[p q r

]Tand properties of skew-

symmetric matrices (Spong et al., 2006), can bereorganized as follows:

Re3T −RS(e3)ωT = R

0 T 0−T 0 00 0 1

pqT

. (30)

Therefore, equation (29) can be rewritten as:

z3 =R

0 T 0−T 0 00 0 1

pqT

+ 2RS(ω)e3T

+RS(ω)S(ω)e3T −m....ξ r +mk1

...E 1 +mE1

+mk2z1 +mkXξ z1 +1

mz1 + k3z2. (31)

At this stage, the vector φ4 = ([p q T ]T )dis the virtual control input, and the control Lya-punov function is chosen as:

V4(ξ, z1, z2, z3) = V3 +1

2zT3 z3, (32)

where its time derivative is given by:

V4 = E1(−k1E1 + z1) + zT1

(− E1 − k2z1 +

1

mz2

− kXξXξ)

+ X Tξ kXξz1 + zT2

(− 1

mz1 − k3z2 + z3

)+ zT3

R 0 T 0−T 0 00 0 1

pqT

+ 2RS(ω)e3T

+RS(ω)S(ω)e3T −m....ξ r +mk1

...E 1 +mE1

+mk2z1 +mkXξ z1 +1

mz1 + k3z2

). (33)

Considering the rotation matrix properties(Spong et al., 2006), the virtual control law is de-fined as:

φ4 =

0 − 1T

01T

0 00 0 1

RT(− 2RS(ω)e3T

−RS(ω)S(ω)e3T +m....ξ r −mk1

...E 1 −mE1

−mk2z1 −mkXξ z1 −1

mz1 − k3z2 − z2

− k4z3), k4 > 0. (34)

Thereby, the time derivative of the candidateLyapunov V4 becomes negative definite:

V4(ξ, z1, z2, z3) = − ET1 k1E1 − zT1 k2z1 − zT2 k3z2

− zT3 k4z3 < 0. (35)

By applying (34) into (31), the closed-loop dy-namics of z3 is given by:

z3 = −z2 − k4z3, (36)

which is asymptotically stable.

• Fifth Step

Comparing the equivalent equations (29) and(31), it can be observed that the third elementof the angular velocity vector ω is not necessaryto control the four steps of the backstepping de-veloped until now. This fact allows yaw con-trol development to fit the whole control system(Mahony and Hamel, 2004).

At this step, it is considered the error betweenreal and reference values of yaw angle ψ. Thiserror and its time derivative are given by:

Eψ =ψ − ψr, (37)

Eψ =ψ − ψr. (38)

The virtual control input is chosen as (ψ)d =φ5(ψ), and the control Lyapunov function is se-lected as:

V5(ψ) =1

2ETψ Eψ. (39)

Its time derivative is given by:

V5(ψ) = ETψ (φ5 − ψr). (40)

By choosing the virtual control law as:

φ5(ψ) = ψr − k5Eψ, k5 > 0, (41)

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

2160

Page 5: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

the time derivative of the candidate Lyapunovfunction becomes negative definite:

V5(ψ) = ETψ (−k5Eψ) = −ETψ k5Eψ < 0, (42)

and so, the equation (38), by adding and subtract-ing φ5, becomes:

Eψ = −ψr + φ5 + [ψ − φ5]. (43)

Now, the change of variable z4 = [ψ− φ5] is used.

• Sixth Step

At this step, the error associated to the timederivative of the yaw angle is stabilized, in which

the integral term Xψ =∫ t0z4(τ)dτ is imple-

mented. Thus, considering the system:

Eψ = −k5Eψ + z4,

Xψ = z4,

z4 = ψ − ψr + k5Eψ, (44)

the virtual control input is chosen as the desiredyaw angle acceleration φ6 = (ψ)d.

The following control Lyapunov function isproposed:

V6 = V5 +1

2zT4 z4 +

1

2X Tψ kXψXψ, (45)

and its time derivative is given by:

V6 =Eψ(−k5Eψ + z4) + z4(ψ − ψr + k5ψ)

+ XψkXψz4, kXψ > 0. (46)

Thus, the virtual control law, φ6, is designed asfollows:

φ6 = ψr − k5ψ − k6z4 − Eψ − kXψXψ, (47)

which ensures that V6 is negative definite:

V6 = −k5ETψ Eψ − k6zT4 z4 < 0, k5, k6 > 0. (48)

and, consequently, the stability of the system (44)is guaranteed.

Now, in order to obtain the closed-loop dy-namics of the quadrotor UAV with the proposedbackstepping controller, firstly, the desired yawangle acceleration, φ6 = (ψ)d, is mapped tothe angular acceleration rd. Hence, assuringthat pitch and roll angles belong to the interval(−π/2, π/2), and from (6), the following second-order differential kinematics is obtained:

η = −Wη−1WηWη−1ω +Wη−1ω. (49)

By multiplying both sides of (49) by eT3 = [0 0 1],

and using ω =[p q r

]T, it is obtained:

ψ = −[0 0 1]Wη−1WηWη−1ω + qsin(φ)

cos(θ)+ r

cos(φ)

cos(θ).

(50)

Assuming (50) as (ψ)d and replacing it by φ6in (47), yields to:

rd =cos(θ)

cos(φ)

(ψr − k5ψ − k6z4 − Eψ − kXψXψ

+[0 0 1]Wη−1WηWη−1ω − qdsin(φ)

cos(θ)

). (51)

Therefore, the complete dynamics of thequadrotor UAV in closed-loop can be rewrittenthrough equations (22), (28), (31) and (44):

E1 = − k1E1 + z1,

Xξ =z1,

z1 = − E1 − k2z1 − kXξXz1 +1

mz2,

z2 = − 1

mz1 − k3z2 + z3,

z3 =R

0 T 0−T 0 00 0 1

pqT

d

+ 2RS(ω)e3T

+RS(ω)S(ω)e3T −m....ξ r +mk1

...E 1

+mE1 +mk2z1 +1

mz1 + k3z2

Eψ = − k5Eψ + z4,

Xψ =z4,

z4 = − [0 0 1]Wη−1WηWη−1ω + qsin(φ)

cos(θ)

+ rdcos(φ)

cos(θ)− ψr + k5Eψ, (52)

with the feedback control inputs (34) and (51)designed to follow the desired trajectories. Usingthese control inputs, the applied control signals tothe system (1)-(4) are obtained as follows:

τa = Iωd + ω × Iω, (53)

T =

∫ ∫Td. (54)

• Stability Analysis

In order to evaluate the complete stability ofthe quadrotor flight, it is analyzed the sum of allcontrol Lyapunov functions chosen in the back-stepping procedure:

V =1

2ET1 E1 +

1

2zT1 z1 +

1

2X Tξ kXξXξ +

1

2zT2 z2

+1

2zT3 z3 +

1

2ETψ Eψ +

1

2zT4 z4 +

1

2XψkXψXψ (55)

and its time derivative is given by:

V = E1(−k1E1 + z1) + zT1

(− E1 − k2z1 +

1

mz2

− kXξXz1)

+ X Tξ kXξz1 + zT2

(− 1

mz1 − k3z2 + z3

)+ zT3

R 0 T 0−T 0 00 0 1

pqT

+ 2RS(ω)e3T

+RS(ω)S(ω)e3T −m....ξ r +mk1

...E 1 +mE1

+mk2z1 +mkXξ z1 +1

mz1 + k3z2

)+ Eψ(−k5Eψ

+ z4) + z4(ψ − ψr + k5ψ) + XψkXψz4, (56)

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

2161

Page 6: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

with kX ξ, kXψ > 0. By applying the controlinputs (34) and (51), yields to:

V = − ET1 k1E1 − zT1 k2z1 − zT2 k3z2 − zT3 k4z3

− k5ETψ Eψ − k6zT4 z4, (57)

which is negative definite, ensuring that the originof the closed-loop system (52) with (34) and (51)is asymptotically stable.

4 Simulation Results

Two simulations were carried out in orderto corroborate the proposed backstepping con-troller1. The first one was obtained with the back-stepping controller without integral action, whichis being called standard backstepping controller,while the second one used the proposed backstep-ping control law with integral action.

The reference used in these simulations isa eight-shaped path in the R3 space, with thequadrotor orientation turned dynamically to thedesired position, and defined by:

xr =1

2cos

(πt

20

)m, yr =

1

2sin

(πt

10

),

zr = 2 − 1

2cos

(πt

20

), ψr = arctan

(yrxr

).

The initial conditions for this path trackingare ξ0 = [0.25 0.25 0]Tm and η = [0 0 π

4 ]T rad. Itwas considered an initial thrust for hovering fligthof T = gm ≈ 21.97N . The occurrence of externaldisturbances is simulated as: ax = 1N at 5s, aφ =2Nm at 10s, ay = 1N at 15s, aθ =2Nm at 20s, az = 1N at 25s, aψ = 2Nm at 30s.The quadrotor UAV parameters were obtainedfrom Raffo (2011).

The backstepping controller gains were tunedas follows:

k1 =

3 0 00 2 00 0 9

, k2 = 7, k3 = 10, k4 = 80,

k5 = 25, k6 = 120, kXξ = 55, kXψ = 130. (58)

All parameters, the trajectory, and configura-tion are exactly the same in both simulations, ex-cept only by the integral gains that appear only inthe proposed controller. It was also simulated thepresence of ±30% parameter uncertainties in thetotal mass and moments of inertia of the quadro-tor UAV.

Figure 2 shows that both controllers track thereference trajectory, even when the initial condi-tions are far away from the trajectory. Note thatthe presence of external disturbances and also pa-rameter uncertainties cause path tracking devia-tions. In Figure 2a, in which is shown the perfor-mance obtained by the backstepping control with-out integral action, the trajectories present offset

1https://www.youtube.com/watch?v=Da2QjrT1hmM

in steady-state, while in Figure 2b the null steady-state error is achieved for the system.

Figure 3 shows the path tracking errors, andcomparing (a) with (b) it is evident, again, howthe integral action reduces the steady-state errors.Figure 4 shows the control input signals’ behavior.

5 Conclusion

This work proposed a backstepping controldesign to perform time-varying path tracking oftranslational position and yaw orientation of aquadrotor. The control design was performedwithout decoupling the cascade quadrotor dy-namic model, and using the rotation matrix asa part of virtual controls in some steps. Therotation matrix properties allow developing thetranslational position control, avoiding singular-ities in this step. The asymptotically stabilityof the closed-loop system was proved in the Lya-punov sense.

Simulation results were presented illustratingthe difference in the steady-state errors’ behav-ior, and highlighting that the proposed controllerwith integral action can guide the system error tozero when constant disturbances affect the UAV.It is interesting to observe that the null errorsteady-state was achieved with the integral actionin a second cascade point of the quadrotor model,which allowed convergence for time-varying refer-ence of the regulated variables.

In future works, real experiments will be per-formed in a quadrotor AscTec Hummingbird, fromAscending Technologies GmbH, available in thelaboratory of MACRO research group.

Acknowledgments

This work has been supported by the Brazil-ian agency CAPES, CNPq and FAPEMIG.

References

Bouabdallah, S., Murrieri, P. and Siegwart, R. (2004).Design and control of an indoor micro quadro-tor, Robotics and Automation, 2004. Proceedings.ICRA’04. 2004 IEEE International Conferenceon, Vol. 5, IEEE, pp. 4393–4398.

Bouabdallah, S. and Siegwart, R. (2005). Backstep-ping and sliding-mode techniques applied to anindoor micro quadrotor, Proceedings of the 2005IEEE international conference on robotics andautomation, IEEE, pp. 2247–2252.

Bouabdallah, S. and Siegwart, R. (2007). Full con-trol of a quadrotor, Intelligent robots and sys-tems, 2007. IROS 2007. IEEE/RSJ internationalconference on, Ieee, pp. 153–158.

Hamel, T., Mahony, R., Lozano, R. and Ostrowski,J. (2002). Dynamic modelling and configuration

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

2162

Page 7: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

0

0.5

2

00.5

0-0.5

4

-0.5

x (m)y (m)

z (m

)

Reference

Nominal Parameters

Parameters +30%

Parameters -30%

(a) Standard Backstepping

0

0.5

2

00.5

0-0.5

4

-0.5

x (m)y (m)

z (m

)

Reference

Nominal Parameters

Parameters +30%

Parameters -30%

(b) Backstepping with Integral Action

Figure 2: Path Tracking

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

erro

rx (

m)

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

erro

ry (

m)

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

erro

rz (

m)

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

time (s)

erro

rψ(r

ad)

Nominal Parameter

Parameters +30%

Parameters -30%

(a) Standard Backstepping

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

erro

rx (

m)

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

erro

ry (

m)

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

erro

rz (

m)

0 10 20 30 40 50 60 70 80

-0.2

0

0.2

time (s)

erro

rψ(r

ad)

Nominal Parameter

Parameters +30%

Parameters -30%

(b) Backstepping with Integral Action

Figure 3: Trajectories Errors

0 10 20 30 40 50 60 70 80

-5

0

5

τ φ (

N.m

)

0 10 20 30 40 50 60 70 80

-5

0

5

τ θ (

N.m

)

0 10 20 30 40 50 60 70 80

-5

0

5

τ ψ (

N.m

)

0 10 20 30 40 50 60 70 80

15

20

25

time (s)

T (

N)

Nominal Parameter

Parameters +30%

Parameters -30%

(a) Standard Backstepping

0 10 20 30 40 50 60 70 80

-5

0

5

τ φ (

N.m

)

0 10 20 30 40 50 60 70 80

-5

0

5

τ θ (

N.m

)

0 10 20 30 40 50 60 70 80

-5

0

5

τ ψ (

N.m

)

0 10 20 30 40 50 60 70 80

15

20

25

time (s)

T (

N)

Nominal Parameter

Parameters +30%

Parameters -30%

(b) Backstepping with Integral Action

Figure 4: Control Input Signals

stabilization for an x4-flyer., IFAC ProceedingsVolumes 35(1): 217–222.

Huang, H., Hoffmann, G. M., Waslander, S. L. andTomlin, C. J. (2009). Aerodynamics and con-trol of autonomous quadrotor helicopters in ag-gressive maneuvering, Robotics and Automation,2009. ICRA’09. IEEE International Conference

on, IEEE, pp. 3277–3282.

Jasim, W. and Gu, D. (2015). Integral backsteppingcontroller for quadrotor path tracking, AdvancedRobotics (ICAR), 2015 International Conferenceon, IEEE, pp. 593–598.

Khalil, H. K. (2002). Nonlinear systems, 3rd, NewJewsey, Prentice Hall 9.

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

2163

Page 8: WHOLE-BODY BACKSTEPPING CONTROL WITH INTEGRAL ACTION OF A - Universidade Federal do ... · 2017. 9. 27. · Teoria de Lyapunov. Sao realizadas simula˘c~oes para corroborar a e ci^encia

Mahony, R. and Hamel, T. (2004). Robust trajectorytracking for a scale model autonomous helicopter,International Journal of Robust and NonlinearControl 14(12): 1035–1059.

Mian, A. A. and Daobo, W. (2008). Modeling andbackstepping-based nonlinear control strategy fora 6 dof quadrotor helicopter, Chinese Journal ofAeronautics 21(3): 261–268.

Raffo, G. V. (2011). Robust control strategies for aQuadRotor helicopter: an underactuated mechan-ical system, PhD thesis, Universidad de Sevilla.

Raffo, G. V., Ortega, M. G. and Rubio, F. R. (2015).Robust nonlinear control for path tracking of aquad-rotor helicopter, Asian Journal of Control17(1): 142–156.

Raptis, I. A., Valavanis, K. P. and Moreno, W. A.(2011). A novel nonlinear backstepping controllerdesign for helicopters using the rotation matrix,IEEE transactions on control systems technology19(2): 465–473.

Serra, P., Cunha, R., Hamel, T., Cabecinhas, D. andSilvestre, C. (2016). Landing of a quadrotor on amoving target using dynamic image-based visualservo control, IEEE Transactions on Robotics32(6): 1524–1535.

Skjetne, R. and Fossen, T. I. (2004). On integral con-trol in backstepping: Analysis of different tech-niques, American Control Conference, 2004. Pro-ceedings of the 2004, Vol. 2, IEEE, pp. 1899–1904.

Spong, M. W., Hutchinson, S. and Vidyasagar, M.(2006). Robot modeling and control.

Tan, C. K., Wang, J., Paw, Y. C. and Ng, T. Y. (2016).Tracking of a moving ground target by a quadro-tor using a backstepping approach based on afull state cascaded dynamics, Applied Soft Com-puting 47: 47–62.

XIII Simposio Brasileiro de Automacao Inteligente

Porto Alegre – RS, 1o – 4 de Outubro de 2017

2164