Abstract

In this paper, a robust adaptive sliding mode control scheme is developed for attitude and altitude tracking of a quadrotor unmanned aerial vehicle (UAV) system under the simultaneous effect of parametric uncertainties and consistent external disturbance. The underactuated dynamic model of the quadrotor UAV is first built via the Newton–Euler formalism. Considering the nonlinear and strongly coupled characteristics of the quadrotor, the controller is then designed using a sliding mode approach. Meanwhile, additional adaptive laws are proposed to further improve the robustness of the proposed control scheme against the parametric uncertainties of the system. It is proven that the control laws can eliminate the altitude and attitude tracking errors, which are guaranteed to converge to zero asymptotically, even under a strong external disturbance. Finally, numerical simulation and experimental tests are performed, respectively, to verify the effectiveness and robustness of the proposed controller, where its superiority to linear quadratic control and active disturbance rejection control has been demonstrated clearly.

1. Introduction

Quadrotor unmanned aerial vehicles (UAVs) have been the focus of robotic research in recent decades. Compared with traditional manned airplane and unmanned fixed-wing flight vehicles, quadrotor has its unique advantages, such as low cost, small size, and hovering and vertical take-off landing. As a result, quadrotor UAV is applicable in many kinds of fields, e.g., collection of photogrammetry images [1], inspection of railways [2], road detection and tracking [3], management of forest health [4], monitoring power lines [5], and package delivery [6].

To perform tasks with high reliability, the quadrotor UAV requires good flight control capabilities. Therefore, the development of a specialized controller, which is able to take into account the quadrotor’s modeling nonlinearity with strongly coupled dynamics, underactuated characteristics, as well as parametric uncertainty, is always desired. Prior effort has been put towards proportional-integral-derivative (PID) control [79], feedback linearization [10, 11], active disturbance rejection control (ADRC) [12, 13], model predictive control [14, 15], internal model control [16], multivariable super-twisting-like-algorithm [17], backstepping control technique [1820], etc.

Sliding mode control (SMC) is a robust and effective method of controller design in nonlinear systems under uncertain conditions [21]. In [22], SMC is designed for a class of underactuated system, and as a typical example, the algorithm is verified in position and attitude stabilization control of a quadrotor UAV. Reinoso et al. [23] present the design of SMC for desired output tracking of a quadrotor. To overcome the potential chattering problem that is frequently encountered in standard SMC, in [24], second-order SMCs including the super-twisting sliding mode controller (ST-SMC), the modified ST-SMC (MST-SMC), and the nonsingular terminal ST-SMC (NSTST-SMC) are designed and implemented in real time for the altitude tracking of a quadrotor aircraft. Meanwhile, Zhou et al. [25] propose a novel terminal sliding mode control (TSMC) scheme for tracking of the reference signal of a quadrotor UAV. Furthermore, a global fast dynamic TSMC technique is introduced in [26] to address finite-time tracking control of a quadrotor system. Ríos et al. and Basci et al. [27, 28] develop a continuous SMC approach to deal with the robust output tracking control problem for a quadrotor. In addition, a fractional-order SMC scheme has been suggested to stabilize the attitude of quadrotors [29, 30].

Besides pure SMC, integration of SMC with other control approaches is also used to realize attitude control and to accomplish the task of trajectory tracking for quadrotor systems. More clearly, Yang et al. [31] consider a hybrid state-feedback control scheme that incorporates robust SMC and optimal linear quadratic regulator (LQR) in a hierarchical multiple-layer structure for a small-scale quadrotor. In [32], a robust nonlinear controller that combines SMC and backstepping technique is proposed, where the regular SMC for attitude inner loop is first developed to guarantee fast convergence of attitude angles and backstepping control is then applied to position loop until the desired attitude is obtained.

It is worth pointing out that, in the aforementioned works, parametric uncertainties and external disturbance have not been considered simultaneously under the framework of SMC. As a matter of fact, the parameters of a quadrotor, e.g., the moments of inertia, are difficult to be measured directly. It is also hard to get the exact values of these parameters even if they can be measured in certain ways. Meanwhile, quadrotor UAVs are inevitably subject to external disturbances during flight, such as wind gusts.

To address the problems of parameter perturbation and external disturbances, an integral predictive/nonlinear controller with robust performance is presented in the case of aerodynamic disturbance as well as uncertain mass and inertial terms [33]. In [34], to compensate for the time-varying parameter uncertainties and external disturbances, a robust guaranteed cost controller and an optimal robust guaranteed cost controller are presented for the set-point tracking of the quadrotor UAV, respectively. A robust attitude stabilization controller is proposed, which consists of a nominal state-feedback controller and a robust compensator, for quadrotor systems under the influences of nonlinear and coupling dynamics, including parametric uncertainties, unmodeled uncertainties, and external disturbances [35]. Besides, in [36], by combining with SMC, a robust backstepping-based approach is investigated for position and attitude tracking of a quadrotor UAV subject to external disturbances and parameter uncertainties, associated with the presence of aerodynamic forces and possible wind force. Moreover, a hierarchical control strategy based on adaptive radial basis function neural networks (RBFNNs) and double-loop integral SMC is presented in [37] for the trajectory tracking of the quadrotor UAV.

In this work, the quadrotor system is considered subject to nonlinear and coupling dynamics, parametric uncertainties, and external disturbances. A novel robust adaptive sliding mode controller (ASMC) is developed to asymptotically reduce the altitude and attitude tracking errors. The main contributions of the paper are summarized as follows: (1) associated with SMC, adaptive laws are designed for simultaneous estimation of all parameters of UAV including mass, arm length, moments of inertia, and coefficients of the quadrotor system. Different from the most parameter-estimation-based controllers that always assume the availability of partial parameters of the UAV and estimate the remaining, the proposed controller shows stronger applicability for different types of quadrotor UAV. (2) The robustness of the proposed controller is guaranteed by the novel learning mechanism that takes a parallel structure. (3) The tracking convergence of the ASMC is verified by rigorous Lyapunov-based analysis, simulations, as well as real experiments.

The remainder of this paper is organized as follows. In Section 2, the dynamics of the quadrotor is presented. The control strategy is exposed in detail in Section 3. In Section 4, both simulation and experiment are conducted to verify the effectiveness of the proposed controller. Section 5 concludes the work.

2. Mathematical Model of Quadrotor UAV

In this section, the mathematical model and control principle of the quadrotor UAV are introduced. The schematic diagram of the quadrotor is shown in Figure 1, where E and B represent the earth and body frames, respectively. In flight experiment of the quadrotor UAV, rotors 1 and 4 are controlled to rotate clockwise, while rotors 2 and 3 are controlled to rotate counterclockwise. It is worth noticing that the left or right motion of the quadrotor UAV will create a roll angle by increasing (decreasing) the speeds of rotors 1 and 3 and decreasing (increasing) the speeds of rotors 2 and 4. Meanwhile, in order to obtain the pitch angle around the y-axis, the quadrotor can be controlled by increasing (decreasing) the speeds of rotors 1 and 2 and decreasing (increasing) the speeds of rotors 3 and 4. Furthermore, to rotate the quadrotor around the z-axis, it is suggested to increase (decrease) the speeds of rotors 1 and 4 and decrease (increase) the speeds of rotors 2 and 3. In addition, taking-off/landing tasks can be accomplished by increasing or decreasing all the rotors’ speed uniformly.

As usual, the following assumptions are given to make the consequent controller design and analysis rigorous [10, 38]:(i)The structure of the quadrotor UAV is rigid, and there are no internal forces or deformations(ii)The structure of the quadrotor UAV is symmetrical(iii)The center of mass and the origin of body frame coincide(iv)The earth frame is an inertial frame

The six degrees of freedom of the quadrotor UAV are defined aswhere is the position vector relative to the inertial frame E and denotes the vector of the roll angle around the x-axis, the pitch angle around the y-axis, as well as the yaw angle around the z-axis. The rotation matrices around each of the three axes are

As such, the rotation matrix from the body frame to the earth frame can be expressed aswhere denotes the transpose of matrix .

In the following, the translational and rotational dynamics of the quadrotor UAV will be exploited consequently. We first address the translational dynamics. Notice that the total lift force generated by the rotors can be given in the body frame aswith being the actual altitude control input, where is the lift force generated by the ith rotor, . According to (5) and (6), the total lift force in the earth frame is then

Meanwhile, the air resistance is proportional to the flight speed of the quadrotor and can be expressed aswhere , , and are the air resistance coefficients in the three directions. Moreover, the effect of gravity of the quadrotor can be described in the earth frame aswhere m is the mass of quadrotor. In summary, applying Newton’s second law, the translational dynamics of the quadrotor UAV subjected to external disturbance can be obtained by (2)–(9) [14, 27].where , , and represent the effect of wind gusts on the translational accelerations in the form of additive external disturbances.

Then, the rotational dynamics of the quadrotor UAV are addressed. Let the vector represent the quadrotor’s angular velocity in the body frame. The angular motion dynamics of the quadrotor can be expressed as [13, 16]where are the components of the resultant torque acting on the quadrotor in the three directions of , respectively, and , , and are the inertias of the quadrotor around , respectively.

Meanwhile, let denote the components of the lifting torque of the quadrotor in the three directions of , respectively. They can be expressed as [32]where L is the arm length of the quadrotor and f is the scaling factor from force to moment. In addition, , and are attitude control inputs and defined as , and , respectively.

Besides, the quadrotor is subject to gyroscopic torque during flight, whose components around the x, y, and z axes, respectively, are given by [32]

In (13), is the inertia of each propeller and , where stands for the angular speed of the ith propeller.

Considering (11)–(13), the angular motion dynamics of the quadrotor can be rewritten in the following form:

Compared with the brushless motor, the propeller is light. Hence, it is reasonable to ignore the moment of inertia caused by the propellers here [26]. Notice that the transformation matrix from to is given by [16, 17]

To ensure flight safety, the attitude angles of the quadrotor are always kept small purposely during the flight. Thus, it follows from (15) that [39]. In consequence, the rotational dynamics of the quadrotor subjected to external disturbance [14, 27] can be derived from (14):where the terms , , and denote the effect of wind gusts on the quadrotor’s angular accelerations in the form of additive external disturbances.

3. Controller Design and Stability Analysis

In this section, a robust ASMC scheme is proposed for the quadrotor UAV system with the goal of tracking the desired altitude and attitude in the presence of parametric uncertainties and consistent external disturbance. The whole control scheme is depicted in Figure 2. It is worth mentioning that although dynamical coupling exists between the translational dynamics (10) and the rotational dynamics (16), can be designed separately [26, 40].

Remark 1. In the control of the quadrotor, the changes of the states ϕ and θ will result in movement in the x and y directions, respectively. Therefore, instead of considering the full six degrees of freedom of the UAV, it is sufficient to control the four degrees of freedom (ϕ, θ, φ, and z) only. In this regard, the considered quadrotor UAV system has a fully actuated dynamic model [38], where four independent control variables are to be designed.

3.1. The State-Space Model of Quadrotor UAV

Letwhere , , , , , , , , , , , and . Then, the dynamic system of the quadrotor UAV, (10) and (16), can be reformulated in the state space:where the altitude controller and the roll, pitch, and yaw controllers will be designed under the framework of ASMC.

To make the subsequent analysis concise and readable, some of the involved disturbance components in (18) are rescaled as , and some of the parameters are redefined as . Moreover, let denote the estimation of . Then, is the estimation error.

Assumption 1. It is assumed that all the disturbances are uniformly bounded, i.e., , , , , , and with known positive constants , , and .

Assumption 2. In the design of controller for the quadrotor, to avoid any singularity, we set [32, 33, 41]

3.2. Altitude Controller Design

We first address . Define the altitude error aswhere is the desired altitude, and set the sliding surface aswith being a positive constant.

The control law of altitude is designed aswhere denotes the signum function, a positive constant, and are learned in the following way:where and are positive learning gains.

The first main result of the paper is summarized as follows.

Theorem 1. Consider the altitude dynamic model of the quadrotor UAV in the state-space form (18) with controllers (22) and adaptive laws (23). Under Assumptions 1 and 2, the altitude output tracking error of the closed-loop system is guaranteed to converge to zero asymptotically, i.e., as .

Proof 1. Define the following Lyapunov function candidate:whose time derivative isFor the first term on the right-hand side of (25), notice from (20) and (21) that the derivative of is given byBy virtue of (26) and the sixth equation in (18), it follows thatFurther substituting the altitude controller (22) into (27) renders to Applying (28) into (25) yieldsSince and by the definitions of , (29) implies that Finally, by substituting the adaptive laws (23) into (30) and adopting the relationship , yielding that if and only if . Define the set of as , that is, . Moreover, is defined as the largest invariant set in . Obviously, the largest invariant set only includes the point . Therefore, the closed-loop system is asymptotically stabilized, i.e., when according to LaSalle’s invariance principle [42]. Observing the detailed expression of the sliding surface (21), the asymptotical convergence of directly gives that of .

3.3. Attitude Controller Design

Now, we are in the position of the attitude controller design, i.e., the control schemes for the roll, pitch as well as yaw channels. We first address the controller of roll channel based on ASMC.

Define the tracking error of roll angleand the corresponding sliding surfacewhere is the desired roll angle and is a positive constant. The control law for is designed aswhere is a positive constant. The parametric adaptive laws for and are set to bewhere are two positive learning gains.

The second main result of the paper is summarized as follows.

Theorem 2. Consider the dynamic model of the quadrotor UAV in the state-space form (18) with controller (34) and adaptive laws (35). Under Assumption 1, the roll output tracking error of the closed-loop system is guaranteed to converge to zero asymptotically, i.e., as .

Proof 2. Define the following candidate of Lyapunov functionDifferentiating with respect to time yieldswhere, by (32) and (33), satisfiesUsing the eighth equation in (18) and (38), the first term on the right-hand side of (37) can be rewritten as By the definitions of and and substituting the roll controller (34) into (39), we have Then, combining (40) and (37) yields Since and , it follows from (41) that Hence, substituting the adaptive laws (35) into (42) and noticing that ,indicating that if and only if . Define the set of as , that is, . Moreover, is defined as the largest invariant set in . Obviously, the largest invariant set only includes the point . Therefore, the closed-loop system is asymptotically stabilized, i.e., when according to LaSalle’s invariance principle [42]. Observing the detailed expression of the sliding surface (33), the asymptotical convergence of directly gives that of .
Parallel to the way in designing the control and adaptive laws for the altitude and roll channels, the controller design for the pitch and yaw channels can be derived similarly and given in the following:where , , , and are positive constants, and are the desired pitch and yaw angles, respectively, and are the tracking errors of pitch and yaw angles, and and are the sliding surfaces, defined as and , respectively.

Remark 2. It is worth mentioning that since the signum functions are involved in the controllers, chattering phenomenon could be serious when the proposed ASMC laws (22), (34), (44), and (46) are applied in the quadrotor UAV system. To resolve this, saturation functions are used to replace the signum functions in all four channels [40]. The resultant control performance has been verified via simulation and real experiment.

4. Simulation and Experimental Tests

In this section, the effectiveness and robustness of the proposed ASMC scheme will be verified via simulation and real experiment, where the performance of LQR and ADRC are given simultaneously for comparison.

4.1. Simulation

In this part, numerical simulations of the LQR, the ADRC, and the proposed ASMC are implemented via Matlab/Simulink. The model parameters of the quadrotor and the design parameters of the ASMC are listed in Tables 1 and 2, respectively.

The initial altitude and attitude of the quadrotor UAV are set as 0 m and rad. The desired/reference position and attitude are assumed to be  m,  rad, and the external disturbances are .

The time histories of the sliding surfaces are illustrated in Figure 3, revealing the fast convergence of all the sliding surfaces. Figure 4 shows the resulting tracking error profiles for the altitude and attitude control of the quadrotor. It can be seen that, despite the disturbances acting on the system, the errors converge within 5 seconds and become very small after that when applying the proposed ASMC to the quadrotor. The convergence speed and disturbance rejection ability for each channel could be optimized by tuning the magnitudes of accordingly. Figure 5 shows the time responses of the LQR, the ADRC, and the proposed ASMC (22), (34), (44), and (46) with saturation function. Since the chattering phenomenon is greatly suppressed, the proposed controller can be easily applied in a real quadrotor UAV system.

Comparison with LQR and ADRC has been carried out and the simulation results are presented in Figures 69. In Figure 6, we can see that LQR induces a larger overshoot although it has a faster tracking speed for the given reference signal. Meanwhile, the tracking speed of the ASMC is significantly faster than that of the ADRC. In Figures 79, the states ϕ, θ, and φ are with smaller vibration when applying the ASMC to the quadrotor system. To sum up, the proposed robust ASMC scheme possesses a better tracking performance for the quadrotor even in the presence of parametric uncertainty and external disturbances.

4.2. Experimental Test

In experiments, the proposed control strategy is applied to a quadrotor UAV platform provided by Beijing Links Tech Co., Ltd., as shown in Figure 10. This platform uses a personal computer (PC), a 51.5 cm  51.5 cm test bench, an external DC power module, a power adapter, an USB to RS485 converter, a wind speed sensor, and an AR Drone 2.0 quadrotor system with 1 GHz 32 bit ARM Cortex A8 processor, 3-axis gyroscope, 3-axis accelerometer, 3-axis magnetometer, barometer, ultrasonic sensor, 4 brushless motors, 4 motor controllers, and a Wi-Fi wireless module. To ensure the test safety, the quadrotor is fixed on the test platform. Meanwhile, a large and powerful electric fan is used to generate wind disturbance and acts on the quadrotor.

The controllers are first implemented in Matlab/Simulink. Then, the code generation technique is used to convert the Simulink model into C language code, which is downloaded to the processor via Wi-Fi. It is worth noting that the altitude controller is not verified in experiment, since the altitude of the quadrotor is fixed.

To evaluate the control performance of the three control schemes, including ASMC, LQR, and ADRC, two flight tests with different wind speeds of external disturbance are carried out on the quadrotor platform. Notice that the initial attitudes of the quadrotor could be different in the actual tests, since the attitude of the quadrotor cannot be measured when the quadrotor is in the stationary state.

Case 1. The quadrotor is expected to achieve the reference tracking of roll and pitch angles of 0 rad under the wind speed of 1.6 m/s.
The tracking performance is demonstrated in Figures 11 and 12, where the oscillation generated by the ADRC is more severe than that by the ASMC and the LQR. In Figure 11, the tracking error of the ASMC is obviously smaller than that of the LQR. However, the ASMC and the LQR provide roughly equal control effects in Figure 12. Furthermore, to quantitatively evaluate the attitude angle tracking performance achieved by the proposed ASMC, LQR, and ADRC, two performance indices, i.e., the maximum value of the absolute value of the tracking error (MAE) and the absolute value of the mean tracking error (AME) are used. As listed in Tables 3 and 4, the MAE of the ASMC is smaller than that of the LQR and the ADRC. Meanwhile, the AMEs of the ADRC are clearly the smallest in roll and pitch channels, since the tracking results of roll and pitch have an almost equal amplitude fluctuation above and below zero. In addition, the tracking accuracy obtained from the ASMC is superior to that of LQR in terms of AME.

Case 2. The quadrotor is expected to achieve the reference tracking of roll and pitch angles of 0 rad under the wind speed of 2.8 m/s.
Figures 13 and 14 present the evolution of the attitude of the quadrotor in time. As can be seen from Figure 13, the tracking result of the ADRC has the largest oscillation. The tracking error of the ASMC is significantly smaller than that of the LQR when the time exceeds 30 s. Furthermore, it can be observed from Figure 14 that the ADRC produces the largest overshoot at the beginning of the flight test and that the ASMC has the smallest steady-state error. As a matter of fact, as shown in Tables 5 and 6, ASMC achieves the best tracking performance in roll and pitch channels in terms of the MAE.
From the above experimental results and quantitative analysis, it can be concluded that the proposed ASMC control scheme is capable of providing remarkable control performance under the simultaneous effect of parametric uncertainties and external disturbance.

5. Conclusion

A robust ASMC scheme is developed for a quadrotor UAV, which guarantees the asymptotic convergence of the tracking error in altitude and attitude. Adaptive laws are designed for estimation of unknown parameters involved in SMC. A rigorous proof of stability of the proposed control algorithm is accomplished through Lyapunov analysis. Numerical simulation and real experiment have been carried out to verify the effectiveness of the proposed controller. It reveals that the ASMC has a better tracking performance than the LQR or the ADRC in terms of the MAE. Future research will investigate the formation control of the quadrotor UAVs using a multiagent system approach [4345].

Appendix

Altitude and attitude controllers of the quadrotor based on LQR are given bywhere is the desired altitude and , , , and .where are the desired roll, pitch, and yaw angles, respectively, and , , , , and .

The ADRC scheme can be expressed bywhere , , and are the reference signal and output of the controlled plant of the corresponding channel, respectively, and is described as

The design parameters of altitude and attitude controller based on ADRC are listed in Table 7.

Data Availability

All data in the manuscript are available.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

Acknowledgments

The work was supported by the Sichuan Science and Technology Program under Grant nos. 2019YFG0345 and 2019YJ0210, the National Natural Science Foundation of China under Grant nos. 61773323, 61433011, 61603316, and 61733015, and the Fundamental Research Funds for the Central Universities under Grant 2682018CX15.