Professional Documents
Culture Documents
8, AUGUST 2016
Abstract—This study gives the mathematic model of a an effective controller for position trajectory tracking control
quadrotor unmanned aerial vehicle (UAV) and then pro- difficult. What’s more, taking robustness of the trajectory track-
poses a robust nonlinear controller which combines the ing controller into consideration poses a bigger challenge.
sliding-mode control technique and the backstepping con-
trol technique. To achieve Cartesian position trajectory In the past few years, researchers have paid attention to con-
tracking capability, the construction of the controller can trol and have proposed different kinds of control methods, such
be divided into two stages: a regular SMC controller for atti- as linear and adaptive PID controls [2], [3], dynamic inver-
tude subsystem (inner loop) is first developed to guarantee sion control [4], feedback linearization control [5], [6], model
fast convergence rapidity of Euler angles and the backstep-
predictive control [7], backstepping control [8], [9], sliding-
ping technique is applied to the position loop until desired
attitudes are obtained and then the ultimate control laws. mode control (SMC) [10], [11], LMI-based linear control [12],
The stability of the closed-loop system is guaranteed by observer-based control [13]–[18], adaptive control [19]–[21],
stabilizing each of the subsystems step by step and the ro- and nonlinear control [22], [23], just to numerate a few. Re-
bustness of the controller against model uncertainty and ex- cently, with the development of intelligence control theory, some
ternal disturbances is investigated. In addition, an adaptive advanced or modified controllers, which combine the aforemen-
observer-based fault estimation scheme is also considered
for taking off mode. Simulations are conducted to demon- tioned basic methods with intelligent control methods, such as
strate the effectiveness of the designed robust nonlinear fuzzy control and switching topology, have been presented for
controller and the fault estimation scheme. a few complicated tasks [24]–[26]. Fault-tolerant control and
Index Terms—Backstepping control, fault estimation, ro- robust control methods are also becoming much more popular
bustness, sliding-mode control (SMC), unmanned aerial for fault tolerance and robustness against disturbances, respec-
vehicle (UAV). tively [20], [27]–[31]. The performances of these controllers are
satisfying in terms of attitude or position trajectory tracking ca-
I. INTRODUCTION
pability when some particular circumstances are considered. For
S a new-born member of the small unmanned aerial vehi-
A cle (UAV) family, quadrotor is becoming a popular topic
among researchers and scholars because of its extensive utility
instance, Tayebi and McGilvray [1] proposed a new feedback
control scheme for attitude stabilization of a quadrotor; Zuo [2]
designed a flight control system capable of not only stabilizing
in several important applications, such as military surveillance, attitude but also tracking a trajectory accurately for an underac-
disaster monitoring, agricultural mapping, and rescue mission, tuated quadrotor aircraft; [18] presented a robust attitude track-
etc [1]. The main advantages of quadrotor UAVs lie in flying ing controller for quadrotors based on the nonlinear disturbance
in any direction, taking off and landing vertically, and hovering observer; Liu et al. [29] proposed a robust controller consist of
at a desired altitude. However, its characteristics, such as non- a nominal feedforward controller, a nominal linear LQR con-
linearity, strong coupling, and underactuating, make designing troller, and a robust compensator to deal with robust attitude
control problem. The proposed controllers aforementioned are
Manuscript received April 05, 2015; revised August 08, 2015 and demonstrated to be effective in some specific cases. However,
November 18, 2015; accepted December 22, 2015. Date of publication
April 07, 2016; date of current version July 08, 2016. This work was sup- all the works above are limited to attitude trajectory tracking
ported by the Aeronautics Science Foundation of China (2014ZC52033) control problem and lack focus on position control which has
and the National Natural Science Foundation of China (61533009, highly important practical utilities. On the other hand, many
61473146, 61374130), a project supported by the Priority Academic
Programme Development of Jiangsu Higher Education Institutions. existing works that aimed at position trajectory tracking control
F. Chen, R. Jiang, K. Zhang, and B. Jiang are with the College of have either paid little attention to robustness and fault tolerance
Automation Engineering and also with the Jiangsu Key Laboratory of of the proposed controllers or preferred a simplified form of
the Internet of Things and Control Technologies, Nanjing University of
Aeronautics and Astronautics, Nanjing 210016, China (e-mail: chen- dynamic equation, for example, Lee et al. [6] presented a feed-
fuyang@nuaa.edu.cn; jrongqiang@163.com; kkzhangnuaa@163.com; back linearization controller and noticed its sensitivity to noise
binjiang@nuaa.edu.cn). and modeling uncertainly, so further presented a sliding-mode
G. Tao is with the Department of Electrical and Computer Engi-
neering, University of Virginia, Charlottesville, VA 22903 USA (e-mail: controller to overcome it; however, the quadrotor dynamics is
gt9s@virginia.edu). a simplified one and the coupling between attitudes and posi-
Color versions of one or more of the figures in this paper are available tions was omitted; Das et al. [9] applied backstepping control
online at http://ieeexplore.ieee.org.
Digital Object Identifier 10.1109/TIE.2016.2552151 on the Lagrangian form of the dynamics of a quadrotor and
0278-0046 © 2016 IEEE. Personal use is permitted, but republication/redistribution requires IEEE permission.
See http://www.ieee.org/publications standards/publications/rights/index.html for more information.
CHEN et al.: ROBUST BACKSTEPPING SLIDING-MODE CONTROL AND OBSERVER-BASED FAULT ESTIMATION FOR A QUADROTOR UAV 5045
by Oxb yb zb with its origin at the center of the mass and the Mb is defined as the torque provided by the rotors with respect
inertia frame which is represented by Oxe ye ze are as shown in to the body-fixed frame, and is described as follows:
Fig. 1. The front (Rotor 1) and the rear (Rotor 3) rotors rotate ⎡ ⎤ ⎡ ⎤
counterclockwise, while the lateral rotors (Rotor 2 and Rotor 4) Mbx lκ(Ω24 − Ω22 )
rotate clockwise to generate the lift force and to balance the yaw Mb = ⎣ Mby ⎦ = ⎣ lκ(Ω23 − Ω21 ) ⎦ (3a)
torque as needed. On varying the rotor speeds altogether with Mbz τ (Ω2 + Ω4 − Ω1 − Ω3 )
2 2 2 2
the same quantity, the lift forces will change, affecting the alti- where Ωi , i = 1, 2, 3, 4 denote rotary speed of the front, right,
tude of the vehicle in this case. Pitch rotation can be obtained rear, and left rotors, respectively; l is the distance between a
by changing the speeds of the front and the rear rotors con- rotor and the center of mass of the quadrotor; κ is the drag force
versely while coupled with translation along Oxb . Roll rotation coefficient; and τ is the reverse moment coefficient.
and translation along Oyb can be obtained in a similar way by Using the Newton–Euler equation, the rotational dynamic
varying the speeds of the lateral ones conversely. The equations equation of the quadrotor is obtained as follows:
describing the dynamics of a quadrotor are basically those of a
rotating rigid body with six degrees of freedom which can be Mb = Jb ω̇b + ωb × Jb ωb + Mg + Md (3b)
derived with Newton–Euler formulas. The complicated motions
of a quadrotor can be described by two typical groups of equa- where Jb = diag(Jx , Jy , Jz ) is a symmetric positive definite
tions, each of which represents a subsystem with coupled terms. constant matrix with Jx , Jy , and Jz being the rotary inertia
The first group is related to the translational positions and the with respect to the Ob xb , Ob yb , and Ob zb axes, respectively;
second group is related to the rotational angles. In this section, the notation × denotes cross multiplication; Mg and Md are the
we will give the quadrotor UAV’s mathematic model including resultant torques due to the gyroscopic effects and the resultant
the navigation equations and the moment equations [1]. of aerodynamic frictions torque. They are given as
Define ξ = [φ, θ, ψ]T ∈ 3 and ωb = [p, q, r]T , where φ, θ,
and ψ denote the angle of roll, pitch, and yaw with respect to
4
T
Mg = ωb × Jr 0, 0, (−1)i+1 Ωi
the inertia frame and p, q, and r denote the angular velocity of i=1
roll, pitch, and yaw with respect to the body-fixed frame. The
rotation matrix from body-fixed frame to inertia frame can be Md = diag(dφ , dθ , dψ )ξ˙ (3c)
obtained as
where Jr is the moment of inertia of each rotor; dφ , dθ , and dψ
⎡ ⎤ are the corresponding aerodynamic drag coefficients.
Cψ Cθ Cψ Sθ Sφ − Sψ Cφ Cψ Sθ Cφ + Sψ Sφ
Rt = ⎣ Sψ Cθ Sψ Sθ Sφ + Cψ Cφ Sψ Sθ Cφ − Cψ Sφ ⎦ (1a) Considering that Jb is nonsingular and transforming (3b), the
−Sθ Cθ Sφ Cθ Cφ following equation can be obtained:
rotors with respect to the body-fixed frame controller constructed based on the regular controller aims to en-
⎡ ⎤ sure the position and yaw angle tracking performance along the
0 reference input {xr (t), yr (t), zr (t), ψr (t)} robustly. The block
F =⎣ 0 ⎦. (7) diagram of a control structure is shown in Fig. 2.
2 2 2 2
κ(Ω1 + Ω2 + Ω3 + Ω4 )
By combining (5) and (6), a compact affine nonlinear equation A. Regular Sliding-Mode Controller for Attitude
of the quadrotor UAV is given Trajectory Tracking Control
Ẋ = f (X) + g(X)U (8) The SMC features acceptable robustness in the presence of
T model uncertainties and external disturbances for a specific class
where X = φ, φ̇, θ, θ̇, ψ, ψ̇, x, x,˙ y, y,˙ z, ż ∈ 12 is the state of nonlinear tracking problems and becomes a good choice for
attitude control of a quadrotor UAV. SMC focuses on designing
variable, f (X) and g(X) are smooth functions on X. Equation
a sliding manifold and discontinuous control laws that drive
(8) is expended as follows:
⎧ the system toward the desired dynamic behavior and ensure
⎪
⎪ x˙1 = x2 the tracking performance. This kind of direct nonlinear control
⎪
⎪
⎪
⎪ x ˙2 = a1 x4 x6 + a2 x4 − a3 x2 + U1 strategy for a complicated coupled nonlinear system avoids the
⎪
⎪
⎪
⎪ x ˙3 = x4 inaccuracy caused by linearization around the operation points,
⎪
⎪
⎪
⎪ x ˙4 = a4 x2 x6 + a5 x2 − a6 x4 + U2 and is extensively applied in nonlinear control problems. In this
⎪
⎪
⎪
⎪ x ˙5 = x6 section, a sliding-mode controller for attitude trajectory tracking
⎨
x˙6 = a7 x2 x4 − a8 x6 + U3 control is developed. The laws presented in this section will be
(9)
⎪
⎪ x˙7 = x8 used directly in the position trajectory tracking controller design
⎪
⎪
⎪
⎪ x˙8 = (Cx 1 Sx 3 Cx 5 + Sx 1 Sx 5 )U4 − a9 x8 part.
⎪
⎪
⎪
⎪ x˙9 = x10 Part of the state variable X is selected to form a new substate
⎪
⎪
⎪
⎪ x˙10 = (Cx 1 Sx 3 Sx 5 − Sx 1 Sx 5 )U4 − a10 x10 variable χ, and the considered attitude dynamic system can be
⎪
⎪
⎪
⎪ x˙11 = x12 extracted as follows:
⎩ ⎧
x˙12 = −g + (Cx 1 Cx 3 )U4 − a11 x12
⎪
⎪ χ˙1 = χ2
⎪
⎪
where , dφ , dθ , dψ , l, κ, C(·) , S(·) , and m are same as those ⎪
⎪ χ˙2 = a1 χ4 χ6 + a2 χ4 − a3 χ2 + US 1
⎨
mentioned earlier and g is the gravity acceleration. Ui , i = χ˙3 = χ4
(11)
1, 2, 3, 4 are the control inputs defined as follows: ⎪
⎪ χ˙4 = a4 χ2 χ6 + a5 χ2 − a6 χ4 + US 2
⎪
⎪
⎪
⎪ χ˙5 = χ6
U1 = lκ(Ω24 − Ω22 )/Jx ⎩
χ˙6 = a7 χ2 χ4 − a8 χ6 + US 3
U2 = lκ(Ω23 − Ω21 )/Jy T
where χ = φ, φ̇, θ, θ̇, ψ, ψ̇ ∈ 6 and the parameters are
U3 = lκ(Ω24 + Ω22 − Ω23 − Ω21 )/Jz
same as the above mentioned ones in (9). Our control ob-
U4 = lκ(Ω21 + Ω22 + Ω23 + Ω24 )/m (10) jective for the attitude system (11) is to ensure the trajec-
tory tracking of {φ(t), θ(t), ψ(t)} along the desired attitude
and ai , i = 1, 2, . . . , 11 are the normalized parameters defined
trajectory {φd (t), θd (t), ψd (t)} by designing SMC laws US =
as follows:
[US 1 , US 2 , US 3 ]T .
Jy − Jz Jr dφ Jz − Jx The regular sliding-mode controller for attitude trajectory
a1 = , a2 = , a3 = , a4 = ,
Jx Jx Jx Jy tracking control starts with the roll angle. A proper sliding man-
Jr dθ Jx − Jy dψ ifold for roll motion control is chosen as follows:
a5 = , a6 = , a7 = , a8 = ,
Jy Jy Jz Jz
s1 = ε̇1 + c1 ε1 (12)
dx dy dz
a9 = , a10 = a11 = . where ε1 = χ1d − χ1 , c1 is a positive constant, and χ1d is the
m m m
desired roll angle command. The derivative of s1 with respect
III. BACKSTEPPING SLIDING-MODE CONTROLLER FOR to time is
POSITION TRAJECTORY TRACKING CONTROL
s˙1 = ε̈1 + c1 ε̇1 = χ̈1d − χ̈1 + c1 ε̇1 = χ̈1d + c1 ε̇1
In this section, a regular sliding-mode controller for attitude
trajectory tracking control is first presented. The SMC tech- − (a1 χ4 χ6 + a2 χ4 − a3 χ2 ) − US 1 = χ̈1d + c1 χ̇1d
nique is then combined with the backstepping control technique − (a1 χ4 χ6 + a2 χ4 − a3 χ2 − c1 χ2 ) − US 1 (13)
to develop a robust backstepping sliding-mode controller for
position trajectory tracking control. The regular sliding-mode where χ̇1d and χ̈1d are the derivative and second derivative
controller is designed to ensure the trajectory tracking capabil- of the desired roll angle command which can be obtained ap-
ity of {φ(t), θ(t)} along the desired roll and pitch angle tra- proximately by stable first- and second-order differential filters.
jectory {φd (t), θd (t)}. The robust backstepping sliding-mode Assume that the state variables in (11) are measurable and the
5048 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 63, NO. 8, AUGUST 2016
SMC law for roll motion is designed as follows: The derivative of (18) with respect to time can be written as
(19) with US 1 , US 2 , US 3 being substituted by (14) and (17)
US 1 = χ̈1 d + c1 ε̇1 − (a1 χ4 χ6 + a2 χ4 − a3 χ2 ) + k1 sign(s1 )
3 3 3
(14)
where sign(·) is the sign function; k1 is a positive constant to be V̇S = si ṡi = −si ∗ ki sign(si ) = −ki |si | ≤ 0.
i=1 i=1 i=1
determined and is also often in accordance to the requirement (19)
of performance and can be acquired through trial and error. Thus, the stability of the attitude system (11) is guaranteed
A Lyapunov candidate is chosen as follows: by (18), (19), ensuring attitude trajectory tracking capability.
1 2 In this section, regular SMC laws for attitude trajectory track-
VS 1 = s . (15) ing control of a quadrotor UAV are presented. Sliding surfaces
2 1
are chosen similarly for each Euler angle and control laws are de-
The derivative of (15) with respect to time can be written as signed under the assumption that state variables in (11) are mea-
(16) when US 1 is substituted surable. Lyapunov-based analysis shows the stability of such an
attitude subsystem. On the basis of the preceding regular SMC
V̇S 1 = s1 ṡ1 laws, a robust backstepping sliding-mode controller for position
trajectory tracking control is presented in the following section.
= s1 χ̈1d + c1 ε̇1 − a1 χ4 χ6 + a2 χ4 − a3 χ2 − US 1
= −s1 ∗ k1 sign(s1 ) B. Robust Backstepping SMC Design for Position
= −k1 |s1 | ≤ 0. (16) Trajectory Tracking Control
The regular sliding-mode controller for attitude control of a
The combination of (15) and (16) implies that the sliding quadrotor UAV presented above is effective in terms of attitude
manifold designed in (12) is reachable. trajectory tracking. It guarantees stability of the attitude subsys-
Similar design procedures can be conducted to design SMC tem and provides tracking capability. However, the controller
laws for trajectory tracking control of pitch angle (χ3 ) and yaw has some deficiencies in realizing position control since that the
angle (χ5 ). The corresponding control laws are designed as dynamic model has an adverse form. In (9), control input U4 is
follows: explicitly related to positions {x(t), y(t), z(t)} and is the single
external excitation for each of these three controlled variables.
US 2 = χ̈3 d + c2 ε̇3 − (a4 χ2 χ6 + a5 χ2 − a6 χ4 ) + k2 sign(s2 )
This means designing a separate sliding control law for each
US 3 = χ̈3 d + c3 ε̇5 − (a7 χ2 χ4 − a8 χ6 ) + k3 sign(s3 )
position variable is impossible. Thus, SMC alone is not suitable
(17)
for position trajectory tracking control. This section presents a
where s2 = ε̇3 + c2 ε3 and s3 = ε̇5 + c3 ε5 are the properly de-
robust backstepping sliding-mode controller based on the afore-
signed sliding manifolds for pitch angle and yaw angle trajectory
mentioned regular SMC law. The forthcoming controller is a
control. ε3 = χ3d − χ3 and ε5 = χ5d − χ5 are state errors. c2 ,
combination of SMC technique and backstepping control tech-
c3 , c4 , k2 , k3 , and k4 are positive constants to be determined
nique. On one hand, backstepping control starts from Cartesian
and need to be tuned by trial and error to reach the requirement
position trajectory tracking, utilizes virtual controls, stabilizes
of performance of the system.
each subsystem, and stops when the desired inner Euler angles
The Lyapunov candidate for attitude system (11) is chosen as
are obtained. On the other hand, we apply the desired Euler
1 2 angle commands to the attitude subsystem and obtain the final
VS = (s + s22 + s23 ). (18) SMC law. Thus, the proposed controller has advantages in both
2 1
CHEN et al.: ROBUST BACKSTEPPING SLIDING-MODE CONTROL AND OBSERVER-BASED FAULT ESTIMATION FOR A QUADROTOR UAV 5049
dealing with nonlinear system (a merit of backstepping con- virtual control to be determined to guarantee the tracking capa-
trol) and possessing robustness against model uncertainties and bility of x9 along with x9r . A Lyapunov candidate in this step
disturbances (the feature and advantage of SMC). Our control is considered as
objective with the proposed controller is to ensure that the po- 1
sition trajectory {x(t), y(t), z(t), ψ(t)} converges to the refer- V3 = z92 (27)
2
ence trajectory {xr (t), yr (t), zr (t), ψr (t)}. The control strategy
where z9 = x9r − x9 is the tracking error between reference
adopted in this section is that the inner loop (φ(t), θ(t), ψ(t)) is
position yr and actual position y. The derivative of V3 with
controlled by sliding-mode laws, and a fast convergence is en-
respect to time is given by
sured to the desired trajectory {φd (t), θd (t), ψd (t)}, while the
outer loop (x(t), y(t), z(t)) is stabilized progressively until the V̇3 = z9 ż9 = z9 (ẋ9r − x10 ) = z9 (ẋ9r − v3 + sp2 ). (28)
ultimate backstepping control laws are obtained.
To stabilize V3 , the virtual control v3 is designed as v3 =
The backstepping SMC design of position trajectory track-
ẋ9r + ρ3 z9 , where ρ3 is a positive constant. By substituting v3
ing control for system (9) starts with position x in the inertia
into (28), the following equation can be obtained:
frame. A sliding-mode manifold sp1 = v1 − x8 is first intro-
duced, where v1 is a virtual control to be determined. The Lya- V̇3 = z9 (ẋ9r − v3 + sp2 ) = −ρ3 z92 + z9 sp2 . (29)
punov candidate chosen for this step is given by
Similar to (23), the state error dynamics is obtained as follows:
1 2
z
V1 = (20) ż9 = −ρ3 z9 + sp2 . (30)
2 7
where z7 = x7r − x7 is the tracking error between reference A Lyapunov function involving the state error z9 is chosen as
position xr and actual position x. The derivative of (20) with 1 2
respect to time is given by V4 = (z + s2p1 + z92 + s2p2 ) (31)
2 7
V̇1 = z7 ż7 = z7 (ẋ7r − x8 ) = z7 (ẋ7r − v1 + sp1 ). (21) and a virtual control v4 = (Cx 1 Sx 3 Sx 5 − Sx 1 Sx 5 )U4 is intro-
To stabilize V1 , the virtual control v1 is designed as v1 = duced. Until now, U4 is undetermined and need to be evaluated.
ẋ7r + ρ1 z7 , where ρ1 is a positive constant. By substituting it The derivative of (31) with respect to time is
into (21), the following equation can be obtained: V̇4 = z7 ż7 + sp1 ṡp1 + z9 ż9 + sp2 ṡp2
V̇1 = z7 ż7 = z7 (−ρ1 z7 + sp1 ) = −ρ1 z72 + z7 sp1 . (22) = V̇2 + z9 (−ρ3 z9 + sp2 ) + s2 (v̇3 − ẋ10 )
After v1 is designed, the state error dynamics of z7 can be = V̇2 − ρ3 z92 + sp2 (z9 + v̇3
obtained as follows:
−(Cx 1 Sx 3 Sx 5 − Sx 1 Sx 5 )U4 + a10 x10 )
ż7 = −ρ1 z7 + sp1 . (23)
= V̇2 − ρ3 z92 + sp2 (z9 + v̇3 − v4 + a10 x10 ). (32)
A second Lyapunov function involving state error z7 is con-
sidered as follows: The stabilization of V4 can be obtained by setting the vir-
tual control as v4 = v̇3 + z9 + a10 x10 + ρ4 sp2 , where ρ4 is a
1 positive constant. Then, (32) becomes
V2 = (z12 + s2p1 ) (24)
2
V̇4 = V̇2 − ρ3 z92 + sp2 (z9 + v̇3 − v4 + a10 x10 )
and a second virtual control v2 = (Cx 1 Sx 3 Cx 5 + Sx 1 Sx 5 )U4 is
introduced. Up to now, as a control input, U4 is still the one to be = V̇2 − ρ3 z92 − ρ4 s2p2 ≤ 0. (33)
determined. The derivative of (24) with respect to time is then
given by The backstepping procedure continues and a new sliding-
mode manifold is introduced as sp3 = v5 − x12 , where v5 is
V̇2 = z7 ż7 + sp 1 ṡp 1 a virtual to be determined. At this step, the error measure is
chosen as
= z7 (−ρ1 z7 + sp 1 ) + sp 1 (v̇1 − ẋ8 )
1 2
= −ρ1 z72 + sp 1 (z7 + v̇1 − (Cx 1 Sx 3 Cx 5 + Sx 1 Sx 5 )U4 + a9 x8 ) V5 = z11 (34)
2
= −ρ1 z72 + sp 1 (v̇1 + z7 + a9 x8 − v2 ). (25) where z11 = x11r − x11 is the tracking error between reference
position zr and actual position z. The derivative of (34) with
The stabilization of V2 can be obtained by designing the
respect to time is given by
virtual control as v2 = v̇1 + z7 + a9 x8 + ρ2 sp1 . By substituting
it into (25), the following inequality can be obtained: V̇5 = z11 ż11 = z11 (ẋ11r − x12 ) = z11 (ẋ11r − v5 + sp3 ).
(35)
V̇2 = −ρ1 z72 + sp 1 (v̇1 + z7 + a9 x8 − v2 ) = −ρ1 z72 − ρ2 s2p 1 ≤0
To stabilize V5 , the virtual control v5 is designed as v5 =
(26)
ẋ11r + ρ5 z11 , where ρ5 is a positive constant. By substituting
where ρ2 is a positive constant.
v5 into (35), the following equation can be obtained:
For the trajectory tracking control of x9 along with x9r , a
sliding manifold sp2 = v3 − x10 is introduced, where v3 is a V̇5 = z11 (ẋ11r − v5 + sp3 ) = −ρ5 z11
2
+ z11 sp3 . (36)
5050 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 63, NO. 8, AUGUST 2016
Similar to (23), the tracking error dynamics are then obtained Remark 3.2: According to Remark 2.1, it is trivial to point
as follows: out that solutions in (42) are meaningful. In particular, the de-
nominator of U4 will not cause singularity since the yaw angle
ż11 = −ρ5 z11 + s3 . (37)
is limited to (−π/2, π/2).
A Lyapunov function involving state error z11 is considered By taking {x1d , x3d , x5r } as desired attitude trajectory, the
as ultimate control laws can be obtained by applying the preceding
1 2 SMC law design procedure and are presented as follows:
V6 = (z + s2p1 + z92 + s2p2 + z11 2
+ s2p3 ) (38) ⎧
2 7 U1 = ẍ1d + c1 ż1 − (a1 x4 x6 + a2 x4 − a3 x2 )
⎪
⎪
and a virtual control v6 = (Cx 1 Cx 3 )U4 is introduced where U4 ⎪
⎪
⎨ + k1 sign(s1 (z1 ))
is unknown till now. The derivative of (38) with respect to time U2 = ẍ3d + c2 ż3 − (a4 x2 x6 + a5 x2 − a6 x4 )
is given by ⎪
⎪
⎪
⎪ + k2 sign(s2 (z3 ))
⎩
V̇6 = z7 ż7 + sp1 ṡp1 + z9 ż9 + sp2 ṡp2 + z11 ż11 + sp3 ṡp3 U3 = ẍ5r + c3 ż5 − (a7 x2 x4 − a8 x6 ) + k3 sign(s3 (z5 ))
(43)
= V̇4 + z11 (−ρ5 z11 + s3 ) + s3 (v̇5 − ẋ12 ) where si (z2i−1 ) = ż2i−1 + c2i z2i−1 , i = 1, 2, 3 are the accord-
= V̇4 − ρ5 z11
2
+ s3 (z11 + v̇5 + g + a12 x12 − v6 ). (39) ingly chosen sliding-mode manifolds.
Ultimate control laws are finally obtained from (42) and (43)
The stabilization of V6 can be obtained by designing the via the SMC and the backstepping control techniques. In ad-
virtual control as v6 = v̇5 + z11 + g + a11 x12 + ρ6 sp3 , where dition, progressive stability analysis of the closed-loop system
ρ6 is a positive constant. Then, (39) becomes guarantees the stability of the overall system (9) and ensures the
V̇6 = V̇4 + V̇5 + s3 (z11 + v̇5 + g + a12 x12 − v6 ) position trajectory tracking capability of the proposed backstep-
ping sliding-mode controller.
= V̇4 − ρ5 z11
2
− ρ6 s2p3 ≤ 0. (40)
The combination of (38) and (40) indicates that the stability of IV. FAULT ESTIMATION FOR A QUADROTOR UAV
the overall system is guaranteed and position trajectory tracking The presented backstepping sliding-mode controller is a typ-
capability is ensured. Ultimate control laws are finally designed ical passive fault-tolerant controller that handles disturbances
from the virtual controls introduced in these backstepping steps. and uncertainties well without knowing their information. This
By associating v2 , v4 , and v6 , a group of virtual controls is section investigates a method that estimates the fault information
obtained as to complement our passive robust position trajectory tracking
v2 = (Cx 1 Sx 3 Cx 5 + Sx 1 Sx 5 )U4 controller design. We know that the vertical taking off and the
hovering mode are the common and important flight modes for
v4 = (Cx 1 Sx 3 Sx 5 − Sx 1 Sx 5 )U4 a quadrotor UAV, and any fault, especially actuator fault, during
v6 = (Cx 1 Cx 3 )U4 . (41) the taking off phase may cause catastrophic consequence and
even crash, resulting in great loss. Thus, we give a practical lin-
Remark 3.1: v2 , v4 , and v6 are combinations of available ear fault estimation module for the simplified model in taking
terms either by measuring or given directly as aforementioned. off and hovering mode instead of a nonlinear one for the com-
Thus, they can be regarded as known in the controlled system plicated complete dynamics. The fault estimation scheme will
(11) and the control input U4 can be solved. work as an alarming module and give a rough estimate of the
Notably, (41) has four degrees of freedom, namely x1 , x3 , occurring faults, indicating the changing trend and amplitude.
x5 , and U4 . We also point out that a reference trajectory for yaw Based on these estimates, a fault-tolerant control algorithm may
angle, i.e. x5r , is usually given in advance as an extra reference be developed. An adaptive observer-based fault estimation is
signal and the corresponding SMC law U3 is directly designed to adopted for its fast implementation.
ensure the rapid convergence of x5 to x5r . Thus, x5 is regarded A multiple-input and multiple-output linear dynamic system
as known and can be replaced by x5r in this case, and the degrees with faults can be written as follows:
of freedom in (41) is reduced such that x1 , x3 , and U4 can be
solved. The solutions are as follows: ẋ(t) = Ax(t) + Bu(t) + Ef (t)
(44)
⎧ y = Cx(t)
⎪
⎪ acv6 − dv4
⎪
⎪ x1d = arctan √
⎪
⎪ av6 c2 + d2 where x(t) ∈ n is the state variable vector, u(t) ∈ m is the
⎪
⎨ c input vector, y(t) ∈ p is the output vector, and f (t) ∈ r is the
x3d = arctan (42) fault. A, B, C, D are known matrices of dimension n × n, n ×
⎪
⎪ d
⎪
⎪ m, p × n, p × m. E ∈ n ×r is the fault distribution matrix.
⎪
⎪
⎩ U4 = a (c + d )v6 + (acv6 − dv4 )
2 2 2 2 2
⎪ In this section, a fault estimation scheme for system (44) is
ad considered with the following assumptions.
where x1d and x3d are desired the roll angle trajectory and Assumption 1: The fault is bounded and the derivative of the
pitch angle trajectory for the inner loop, and U4 is part of fault is bounded, that is,
the ultimate control laws, and a = cos(x5r ), b = sin(x5r ),
˙
c = (v2 + v4 ) /v6 and d = a + b. f (t) ≤ f0 , f (t) ≤ f1 (45)
CHEN et al.: ROBUST BACKSTEPPING SLIDING-MODE CONTROL AND OBSERVER-BASED FAULT ESTIMATION FOR A QUADROTOR UAV 5051
Fig. 5. (a) Uncertainty 25% subtracted in all three axes. (b) Uncertainty 25% subtracted in all three axes with filtered control signals. (c) Control
signals. (d) Filtered control signals.
1 0 z1
w= (60)
0 1 z2
0 1 z1 0
= + (u + f1 ) (59)
−0.005 0 z2 1 where w is the output.
5054 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 63, NO. 8, AUGUST 2016
VI. CONCLUSION
Fig. 8. Space diagram of position with uncertainty and white Gaussian In this paper, we first present a regular sliding-mode controller
noise. design for attitude control of a quadrotor UAV. On the basis of
this design, we combine SMC technique and backstepping con-
trol technique to design a robust backstepping sliding-mode con-
troller for position and yaw angle control. Virtual control inputs
are introduced in the robust controller design to guarantee the
trajectory tracking performance. Sliding manifolds are designed
to drive the actual variables to approximate the virtual ones. We
present the stability analysis of the overall system through Lya-
punov stability theory. Fault estimation is also considered in this
study and is applied to the take-off phase of a quadrotor. The
simulation results show that robustness and improved tracking
performance can be achieved with the proposed robust sliding-
mode controller. The simulation results also demonstrate the
effectiveness of the presented fault estimation method. Our fu-
Fig. 9. Estimation of invariant fault.
ture works includes considering actuator fault and developing
an active fault-tolerant controller based on the control design
and fault estimation scheme proposed in this paper.
REFERENCES
[1] A. Tayebi and S. McGilvray, “Attitude stabilization of a VTOL quadrotor
aircraft,” IEEE Trans. Control Syst. Technol., vol. 14, no. 3, pp. 562–571,
May 2006.
[2] Z. Zuo, “Trajectory tracking control design with command-filtered com-
pensation for a quadrotor,” IET Control Theory Appl., vol. 4, no. 11, pp.
2343–2355, Jan. 2010.
[3] P. E. I. Pounds, D. R. Bersak, and A. M. Dollar, “Stability of small-scale
UAV helicopters and quadrotors with added payload mass under PID
control,” Auton. Robot., vol. 33, nos. 1/2, pp. 129–142, Aug. 2012.
[4] A. Das, K. Subbarao, and F. Lewis, “Dynamic inversion with zero-
dynamics stabilisation for quadrotor control,” IET Control Theory Appl.,
vol. 3, no. 3, pp. 303–314, 2009.
[5] A. Mokhtari, A. Benallegue, and Y. Orlov, “Exact linearization and
sliding-mode observer for a quadrotor unmanned aerial vehicle,” Int. J.
Robot. Autom., vol. 21, no. 1, pp. 39–49, 2006.
Fig. 10. Estimation of time-varying fault and estimation error. [6] D. Lee, H. J. Kim, and S. Sastry, “Feedback linearization vs. adaptive
sliding-mode control for a quadrotor helicopter,” Int. J. Control Autom.
Syst., vol. 7, no. 3, pp. 419–428, Jun. 2009.
The parameters given in Theorem 1 can be obtained through [7] K. Alexis, G. Nikolakopoulos, and A. Tzes, “Model predictive quadrotor
LMI toolbox in MATLAB. The corresponding observer gain control: Attitude, altitude and position experimental studies,” IET Control
matrix L and the corresponding F is solved as Theory Appl., vol. 6, no. 12, pp. 1812–1827, Aug. 2012.
[8] C. H. Lin, S. S. Jan, and F. B. Hsiao, “Autonomous hovering of
0.5000 −22.5519 an experimental unmanned helicopter system with proportional-integral
L= , F = 0 1. (61) sliding-mode control,” J. Aerosp. Eng., vol. 24, no. 3, pp. 338–348, Jul.
23.5469 0.5000 2010.
[9] A. Das, F. Lewis, and K. Subbarao, “Backstepping approach for control-
Simulations are conducted with these parameters and the re- ling a quadrotor using Lagrange form dynamics,” J. Intell. Robot. Syst.,
sults for fault estimation are shown in the following figures. vol. 56, nos. 1/2, pp. 127–151, Sep. 2009.
CHEN et al.: ROBUST BACKSTEPPING SLIDING-MODE CONTROL AND OBSERVER-BASED FAULT ESTIMATION FOR A QUADROTOR UAV 5055
[10] A. R. Merheb, H. Noura, and F. Bateman, “Design of passive fault-tolerant [34] Y. Zhang and J. Jiang, “Bibliographical review on reconfigurable fault-
controllers of a quadrotor based on sliding-mode theory,” Int. J. Appl. tolerant control systems,” Ann. Rev. Control, vol. 32, no. 2, pp. 229–252,
Math. Comput. Sci., vol. 25, no. 3, pp. 561–576, 2015. Dec. 2008.
[11] T. Wang, W. F. Xie, and Y. M. Zhang, “sliding-mode reconfigurable control [35] K. Zhang, B. Jiang, and P. Shi, “Fast fault estimation and accommodation
using information on the control effectiveness of actuators,” J. Aerosp. for dynamical systems,” IET Control Theory Appl., vol. 3, no. 2, pp. 189–
Eng., vol. 27, no. 3, pp. 587–596, May 2014. 199, 2009.
[12] T. Ryan and H. J. Kim, “LMI-based gain synthesis for simple robust [36] J. Liu, S. Laghrouche, and M. Harmouche, “Adaptive-gain second-order
quadrotor control,” IEEE Trans. Autom. Sci. Eng., vol. 10, no. 4, pp. sliding-mode observer design for switching power converters,” Control
1173–1178, Oct. 2013. Eng. Pract., vol. 30, pp. 124–131, 2014.
[13] M. Kerma, A. Mokhtari, B. Abdelaziz, and Y. Orlov, “Nonlinear H-infinity [37] J. Liu, S. Laghrouche, and M. Wack, “Observer-based higher order sliding-
control of a quadrotor (UAV), using high order sliding-mode estimator,” mode control of power factor in three-phase AC/DC converter for hybrid
Int. J. Control, vol. 85, no. 12, pp. 1876–1885, 2012. electric vehicle applications,” Int. J. Control, vol. 87, no. 6, pp. 1117–1130,
[14] L. Besnard, Y. B. Shtessel, and B. Landrum, “Quadrotor vehicle control 2014.
via sliding-mode controller driven by sliding-mode disturbance observer,” [38] S. Laghrouche, J. Liu, and F. S. Ahmed, “Adaptive second-order sliding-
J. Franklin Inst., vol. 349, no. 2, pp. 658–684, Mar. 2012. mode observer-based fault reconstruction for PEM fuel cell air-feed sys-
[15] A. Benallegue, A. Mokhtari, and L. Fridman, “High order sliding-mode tem,” IEEE Trans. Control Syst. Technol., vol. 23, no. 3, pp. 1098–1109,
observer for a quadrotor UAV,” Int. J. Robust Nonlinear, vol. 18, nos. 4/5, May 2015.
pp. 427–440, Mar. 2008. [39] S. Yin, X. Zhu, and O. Kaynak, “Improved PLS focused on key-
[16] X. Wang, B. Shirinzadeh, and M. H. Ang, “Nonlinear double-integral performance-indicator-related fault diagnosis,” IEEE Trans. Ind. Elec-
observer and application to quadrotor aircraft,” IEEE Trans. Ind. Electron., tron., vol. 62, no. 3, pp. 1651–1658, Mar. 2015.
vol. 62, no. 2, pp. 1189–1200, Feb. 2015. [40] S. Yin, S. X. Ding, and X. Xie, “A review on basic data-driven approaches
[17] R. C. Leishman, J. C. Macdonald, and R. W. Beard, “Quadrotors and for industrial process monitoring,” IEEE Trans. Ind. Electron., vol. 61, no.
accelerometers: State estimation with an improved dynamic model,” IEEE 11, pp. 6418–6428, Nov. 2014.
Control Syst. Mag., vol. 34, no. 1, pp. 28–41, Feb. 2014. [41] S. Yin, X. Li, and H. Gao, “Data-based techniques focused on modern
[18] K. Lee, J. Back, and I. Choy, “Nonlinear disturbance observer based robust industry: An overview,” IEEE Trans. Ind. Electron., vol. 62, no. 1, pp.
attitude tracking controller for quadrotor UAVs,” Int. J. Control Autom., 657–667, Jan. 2015.
vol. 12, no. 6, pp. 1266–1275, Nov. 2014.
[19] X. J. Chen, D. Li, and Y. Bai, “Modelling and nero-fuzzy adaptive control
for eight-rotor MAV,” Int. J. Control Autom., vol. 9, no. 6, pp. 1154–1163,
2011.
[20] T. Lee, “Robust adaptive attitude tracking on with an application to a
quadrotor UAV,” IEEE Trans. Control Syst. Technol., vol. 21, no. 5, pp.
1924–1930, Sep. 2013. Fuyang Chen received the D.E. degree in au-
[21] Z. T. Dydek, A. M. Annaswamy, and E. Lavretsky, “Adaptive control tomation engineering from the Nanjing Univer-
of quadrotor UAVs: A design trade study with flight evaluations,” IEEE sity of Aeronautics and Astronautics, Nanjing,
Trans. Control Syst. Technol., vol. 21, no. 4, pp. 1400–1406, Jul. 2013. China, in 2013.
[22] X. Wang, B. Shirinzadeh, and M. H. Ang, “Nonlinear double-integral He is currently a Professor with the Nan-
observer and application to quadrotor aircraft,” IEEE Trans. Ind. Electron., jing University of Aeronautics and Astronautics.
vol. 62, no. 2, pp. 189–200, Feb. 2015. His research interests include adaptive control,
[23] L. Wang and J. Su, “Robust disturbance rejection control for attitude flight control, quantum control, and self-repairing
tracking of an aircraft,” IEEE Trans. Control Syst. Technol., vol. 23, no. 6, control.
pp. 2361–2368, Nov. 2015.
[24] B. Erginer and E. Altuğ, “Design and implementation of a hybrid fuzzy
logic controller for a quadrotor VTOL vehicle,” Int. J. Control Autom.,
vol. 10, no. 1, pp. 61–70, Feb. 2012.
[25] Y. Wang, Q. Wu, and Y. Wang, “Consensus algorithm for multiple quadro-
tor systems under fixed and switching topologies,” Syst. Eng. Electron. J.,
vol. 24, no. 5, pp. 818–827, 2013.
Rongqiang Jiang received the B.E. degree in
[26] G. Nikolakopoulos and K. Alexis, “Switching networked attitude control automation engineering from the Nanjing Uni-
of an unmanned quadrotor,” Int. J. Control Autom., vol. 11, no. 2, pp.
versity of Post and Telecommunication, Nanjing,
389–397, Apr. 2013.
China, in 2014. He is currently working toward
[27] H. Liu, Y. Bai, G. Lu, Z. Shi, and Y. Zhong, “Robust tracking control of a
the Master’s degree in the Department of Au-
quadrotor helicopter,” J. Intell. Robot. Syst., vol. 75, nos. 3/4, pp. 595–608, tomation, Nanjing University of Aeronautics and
Sep. 2014.
Astronautics, Nanjing, China.
[28] A. Chamseddine, D. Theilliol, Y. M. Zhang, C. Join, and C. A. Rab-
His research interests include adaptive con-
bath, “Active fault tolerant control system design with trajectory replan- trol, failure detection, and fault-tolerant control.
ning against actuator faults and saturation: Application to a quadrotor
unmanned aerial vehicle,” Int. J. Adapt. Control, vol. 29, no. 1, pp. 1–23,
2014.
[29] H. Liu, G. Lu, and Y. Zhong, “Robust LQR attitude control of a 3-DOF lab-
oratory helicopter for aggressive maneuvers,” IEEE Trans. Ind. Electron.,
vol. 60, no. 10, pp. 4627–4636, Jan. 2013.
[30] S. Islam, P. X. Liu, and A. El Saddik, “Robust control of four rotor
unmanned aerial vehicles with disturbance uncertainty,” IEEE Trans. Ind. Kangkang Zhang received the B.E. degree in
Electron., vol. 62, no. 3, pp. 1563–1571, Mar. 2014. control technology and instruments from the
[31] H. Liu, J. Xi, and Y. Zhong, “Robust motion control of quadrotors,” J. Xi’an University of Post and Telecommunication,
Franklin Inst., vol. 351, no. 12, pp. 5494–5510, Dec. 2014. Xi’an, China, in 2013. He is currently working to-
[32] A. Nasiri, S. K. Nguang, and A. Swain, “Adaptive sliding-mode control ward the Master’s degree in the Department of
for a class of MIMO nonlinear systems with uncertainties,” J. Franklin Automation, Nanjing University of Aeronautics
Inst., vol. 351, no. 4, pp. 2048–2061, Jan. 2014. and Astronautics, Nanjing, China.
[33] J. E. Slotine, “Sliding controller design for non-linear systems,” Int. J. His research interests include aircraft model-
Control, vol. 40, no. 2, pp. 421–434, Aug. 1984. ing, adaptive control, failure detection, and fault-
tolerant control.
5056 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 63, NO. 8, AUGUST 2016
Bin Jiang (SM’05) was born in Jiangxi, China, in Gang Tao (F’07) received the B.S. degree in
1966. He received the Ph.D. degree in automatic electrical engineering from the University of Sci-
control from Northeastern University, Shenyang, ence and Technology of China, Hefei, China, in
China, in 1995. 1982, and the M.S. degrees in electrical en-
He is currently a Professor and the Dean of gineering, computer engineering, and applied
the College of Automation Engineering at the mathematics in 1984, 1987, and 1989, respec-
Nanjing University of Aeronautics and Astronau- tively, and the Ph.D. degree in electrical engi-
tics, Nanjing, China. neering from the University of Southern Califor-
Dr. Jiang is the Chair of the Control Sys- nia, Los Angeles, CA, USA, in 1989.
tems Chapter in the IEEE Nanjing Section and He is currently a Professor at the University
a Member of the International Federation of Au- of Southern California. He was a Visiting Profes-
tomatic Control Technical Committee on Fault Detection, Supervision, sor with the Nanjing University of Aeronautics and Astronautics, Nanjing,
and Safety of Technical Processes. He currently serves as an Associate China. His research interests include adaptive control of systems with
Editor or Editorial Board Member for a number of journals, such as the uncertain actuator nonlinearities and failures, structural damage and
IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY; International sensor uncertainties, and aircraft flight control applications.
Journal of Control, Automation and Systems; Nonlinear Analysis: Hybrid
Systems; International Journal of Applied Mathematics and Computer
Science; Acta Automatica Sinica; and Journal of Astronautics.