Abstract

This paper presents an active fault-tolerant control strategy for quadrotor helicopters to simultaneously accommodate sensor faults and external disturbances. Unlike most of the existing fault diagnosis and fault-tolerant control schemes for quadrotor helicopters, the proposed fault diagnosis scheme is able to estimate sensor faults while eliminating the effect of external disturbances. Moreover, the proposed fault-tolerant control scheme is capable to eliminate the adverse effect of external disturbances as well by designing a disturbance observer to effectively estimate the unknown external disturbances and integrating with the designed integral sliding-mode controller. In this case, the continuous operation of the quadrotor helicopter is ensured while avoiding the unexpected control chattering. In addition, the stability of the closed-loop system is theoretically proved. Finally, the effectiveness and advantages of the proposed scheme are validated and demonstrated through comparative numerical simulations of the quadrotor helicopter under different faulty and uncertain scenarios.

1. Introduction

Unmanned quadrotor helicopters have recently been widely used by commercial industries and academic communities due to their vertical take-off and landing capability, low cost, and great maneuverability. In order to allow the aircraft to track desired orientation commands, while preventing it from flipping over and crashing, the quadrotor attitude control system is becoming more and more sophisticated with increasing requirements for high performance and reliability. Many control approaches have been proposed for tracking control of quadrotor helicopters [13]. However, most of the aforementioned literatures did not take potential faults in the system into account. Sensors are identified as the weak link in aerospace engineering systems based on being more vulnerable to damage or being more sensitive in construction than other components [4, 5]. A fault in an attitude sensor can be regarded as an unexpected change of sensor operation affecting the sensor output [6, 7]. In the case of sensor faults, measurements of state variables and other quantities of interests may no longer be reliable which may degrade quadrotor flight performance or even cause a catastrophic accident. Thus, the faulty measurements cannot be used for output or state feedback control directly without any correction algorithms. To meet the stringent demands of system reliability, physical redundancy in the form of identical sensors or multiple types of sensors is often configured [8]. Nevertheless, redundant sensors are not always feasible due to the constraints of cost, weight, and complexity, especially for small-size unmanned aerial vehicles (UAVs). In this case, analytical redundancy constituted by the knowledge of the considered system becomes a viable supplement. In the study by Zhong et al. [9], a two-stage extended Kalman filter is developed for detecting, isolating, and identifying inertial measurement unit (IMU) sensor faults of an unmanned quadrotor helicopter, while mitigating the impact of model uncertainties. In the study by Matus-Vargas et al. [10], a fault-tolerant control scheme for a multirotor with altitude sensor faults caused by the ground effect is presented and validated by simulations and experiments. In the study by Zhang and Xiao [11], a sliding mode observer with the adaptive regulation law is proposed for multiple sensor fault detection and reconstruction without knowing the upper bound of the unknown faults. In the study by Tan et al. [12], a sliding mode control combined with the RBF neural network is designed to deal with the failures of the sensor and actuator. Considerable research results have been reported on sensor fault diagnosis. A fault diagnosis system normally performs three major tasks: fault detection, fault isolation, and fault estimation. Among various types of fault diagnosis approaches that have been developed, sliding mode observer-based fault diagnosis has been proven to be an effective way to detect, isolate, and estimate faults for many systems due to the inherent robustness of sliding mode algorithms to unknown modeling uncertainties and disturbances [1315]. In the study by Patton et al. [13], the derivative of the considered sensor fault is assumed to be zero, and the concept of equivalent output injection is employed to reconstruct the fault. Then, in the study by Tan and Edwards [14], the assumption of constant sensor fault is relaxed to a more general case but it assumes that the considered system needs to be open-loop stable. In the study by Alwi et al. [15], the proposed scheme overcomes the limitation that the open-loop system is required to be stable and is capable to estimate incipient sensor faults. Note that, the aforementioned research only deals with the diagnosis of sensor faults. From the control point of view, after fault occurrence, whether the fault can be compensated and the system can maintain its original tracking performance are of importance. In other words, the integrated design of the controller and fault diagnosis scheme needs to be further investigated. The stability of the closed-loop system with reconstructed measurements needs to be proved. Therefore, with application to quadrotor helicopters, the fault diagnosis and fault-tolerant control for quadrotor helicopters has been an important research topic in recent years with the growing demands for safety, reliability, and maintainability [1618]. The timely diagnosis and correction of faults in a quadrotor system are critical in avoiding abnormal system performance and reducing the unexpected accidents significantly.

During the last decade, various fault diagnosis approaches have been proposed with the advances in control theory [1923]. Most of the proposed diagnosis systems contain only fault detection and isolation (FDI), which cannot provide more comprehensive information of the corresponding fault, such as magnitude of the fault. Fault estimation, which is also referred to as fault identification, can provide the estimated magnitude of the fault. It plays an important role in active fault-tolerant control (AFTC) since it can provide the required fault information to reconfigure the controller. In [24, 25], nonlinear adaptive estimation methods are presented to detect, isolate, and estimate sensor bias faults in accelerometer and gyroscope measurements of a quadrotor helicopter. In the study by Zhong et al. [26], an adaptive two-stage extended Kalman filter is proposed for sensor fault detection and diagnosis of a quadrotor helicopter based on its kinematic model. Nonetheless, fault diagnosis is a very important procedure, and it is not sufficient to ensure safe operation of the quadrotor helicopter. For safety-critical systems, the diagnosis of a particular system fault is not the ultimate goal, whereas the continuity of operation is a key feature, and the closed-loop system should be capable of maintaining its prespecified performance in terms of quality, safety, and stability despite the presence of faults [27]. This calls for the appearance of FTC systems.

In the context of FTC for quadrotor helicopters, most of the research works in the literature focus on actuator faults [2832]. Research on sensor FTC for quadrotor helicopters is very limited compared to the sensor fault diagnosis system and actuator FTC system [33, 34]. In the study by Zhang et al. [33], a tracking controller and a sensor fault detection and isolation scheme were separately developed for a quadrotor helicopter. The proposed fault diagnosis system can only detect and isolate sensor faults and is not integrated with the designed controller to accommodate faults in an active fashion. In the study by Qin et al. [34], a fault diagnosis unit is designed to estimate sensor faults and synthesized with a two-level PID controller to constitute an active FTC scheme for a quadrotor helicopter. However, the proposed scheme in [34] is based on a linear model of the quadrotor helicopter. In practical situations, the existence of system parameter variations, nonlinearity, and disturbances can make the model-based fault diagnosis and FTC system ineffective. Consequently, it is vital to take robustness into consideration, while designing model-based fault diagnosis and FTC systems.

In an attempt to solve the aforementioned difficulties for improving system robustness, this paper presents a novel observer-based fault diagnosis and FTC scheme for quadrotor helicopters against sensor faults and disturbances. The main contributions of this paper are summarized as follows:(1)In the face of sensor faults and external disturbances, an active FTC scheme is proposed to simultaneously accommodate them in terms of both fault diagnosis and fault-tolerant control based on integral sliding-mode control, sliding mode observer, and disturbance observer.(2)Unlike most of the existing fault diagnosis schemes for quadrotor helicopters, the proposed fault diagnosis scheme is able to estimate sensor faults, while eliminating the effect of external disturbances.(3)A disturbance observer is constructed to estimate the lumped disturbances and integrated with the designed sliding-mode controller, which can help to avoid the unexpected control chattering. The stability of the closed-loop system is theoretically proved.

The rest of this paper is arranged as follows. The dynamic model of the studied quadrotor helicopter and problem statement are presented in Section 2. The detailed design procedures of the proposed fault diagnosis and FTC scheme are described in Section 3. Then, the numerical simulation results are demonstrated in Section 4 to validate the effectiveness of the proposed scheme. Finally, general conclusions of this paper are summarized in Section 5.

2. Quadrotor Model and Problem Statement

2.1. Quadrotor Model Description

The studied quadrotor helicopter is an underactuated system with six degrees of freedom driven by four motors mounted in a cross configuration, as shown in Figure 1. The voltage inputs imposed on the motors drive the corresponding propellers to generate forces and torques. Each pair of the opposite propellers turns the same way, i.e., the front and rear propellers rotate clockwise and the left and right ones spin counterclockwise. In order to facilitate the modeling of the quadrotor helicopter, two coordinate systems are employed: the earth-fixed frame {E} and the body-fixed frame {B}. The origin of the earth-fixed frame is attached on the ground, while the origin of the body-fixed frame is coincident with the center of gravity of the studied quadrotor helicopter. The axes of the earth-fixed frame are denoted as (), and the axes of the body-fixed frame are denoted as ().

Considering the attitude control of the quadrotor helicopter, by employing the Newton–Euler formulation, the dynamic model of the quadrotor helicopter can be expressed as follows:where is the resultant torque vector and is the angular velocity vector with respect to the body-fixed frame, respectively, and is a diagonal matrix that stands for the moments of inertia of three axes of the studied quadrotor helicopter with the assumption that the axes of the body-fixed frame are coincident with the principal axes of inertia of the studied quadrotor helicopter.

The corresponding torques imposed on the quadrotor helicopter consist of the propeller-generated torque, the gyroscopic torque, and the rotational motion-induced torque, which can be described aswhere is the roll, pitch, and yaw angle of the quadrotor helicopter defined in the earth-fixed frame, respectively, is the inertial moment of the propeller, is the ith propeller's rotational speed, is the drag coefficient, and is the pulse width modulation (PWM) input of the ith motor, and the control input signals are within the range [0.05, 0.1]. A command of 0.05 corresponds to zero throttle, which will cause the motors to stop, and a command of 0.1 corresponds to full throttle. is a positive gain related to propeller-generated force, is a positive gain related to propeller-generated torque, and is the distance between the motor and the center of gravity of the quadrotor helicopter.

Then, by substituting (2) into (1), it leads towhere .

The kinematic differential equation of the quadrotor helicopter can be described as

Assuming that the changes of roll and pitch angles are small, the transformation matrix between the angular velocities and the Euler angle rates is close to an identity matrix. Thus, the nonlinear system in (4) is linearized as

To facilitate the subsequent design procedures, (3) and (5) are simplified as the following nonlinear affine system:where r represents the lumped model uncertainties and external disturbances, which are assumed to be unknown but bounded, and is an unknown vector which represents an additive bias resulting from sensor faults.

According to the above definitions, the known constant matrices in (6) can be described as

3. Active Fault-Tolerant Control Strategy

3.1. Overview of the Proposed AFTC Scheme

A general structure of the developed AFTC scheme against sensor faults and disturbances is illustrated in Figure 2. The overall control system is constructed by a sensor fault diagnosis unit and a disturbance observer-based sliding-mode controller. The real-time information about sensor faults is provided by the fault diagnosis unit. Subsequently, the disturbance observer-based sliding-mode controller is proposed and integrated with the fault diagnosis unit to drive the quadrotor helicopter track the reference signals in the presence of sensor faults and disturbances.

3.2. Sensor Fault Diagnosis

Assumption 1. rank(CW) = rank(W).

Assumption 2. The nonlinear term is assumed to be known and Lipschitz about uniformly, ,where is the Lipschitz constant and is assumed to be unknown.

Assumption 3. The considered sensor faults and their derivatives are bounded and defined by

Lemma 1. Under Assumption 1, there exist linear transformations of state and output:such that the system matrices becomewhere , , , , , , , , , , , , , and .

By applying both transformation matrices and , original system (6) can be converted into the following two subsystems as

After coordinate transformations, one can observe that subsystem (12) is only sensitive to lumped disturbances, and subsystem (13) is free from lumped disturbances but subject to sensor faults. In order to estimate , the sensor faults in (13) are treated as actuator faults by defining a new state . In this case, an augmented system with the state vector can be given aswhere , , , , , , , and .

Moreover, since is used in subsystem (12), with the new state vector , subsystem (12) can be accordingly rewritten aswhere .

Therefore, for subsystems (15) and (14), two sliding mode observers are designed as follows:where is a stable matrix that needs to be determined, is the Lyapunov matrix of is the observer gain matrix with , and .

The discontinuous output error injection term , which is used to eliminate the effects of disturbances on state estimation, is designed aswhere is a positive scalar to be determined.

Similarly, the discontinuous output error injection term can be designed aswhere is a matrix and is a positive scalar that needs to be determined.

In addition, and are determined by the following adaptation laws aswhere and are positive constants.

Then, by defining the state estimation errors as and , the corresponding sliding surface can be constructed as

Accordingly, the state estimation error dynamics can be obtained as follows:

Considering the fact that, after reaching the constructed sliding surface, the desired sliding motion needs to be maintained thereafter, namely, , which results in thatwhere denotes the equivalent output error injection signal, which can be approximated aswith representing a small positive scalar for reducing the chattering effect.

In this sense, according to (25), the sensor fault can be approximated as

Theorem 1. Given a nonlinear affine system (6) with Assumptions 13 and the proposed observers (16) and (17), by employing adaptation schemes (20) and (21), state estimation error dynamics (23) and (24) can be driven to the defined sliding surface given by (22) if the gains and satisfy thatwhere and are positive scalars.

Proof of Theorem 1. Consider the following Lyapunov candidate functions:Then, by substituting equations (23) and (24), the time derivative of and can be, respectively, calculated asSince and , (31) and (32) can be rewritten as follows:Finally, substituting (28) and (29) into (33) and (34) leads to thatTherefore, the desired sliding motion can be achieved and maintained.

3.3. Integral Sliding-Mode Control Design

The design of a sliding mode controller is typically composed of two steps. The first step features the construction of a sliding surface, on which the system performance can be maintained as expected. The second step is concerned with the selection of an appropriate control law to drive the sliding variable reach the designed sliding surface and thereafter keep the sliding motion within the close neighborhood of the sliding surface. However, during the reaching phase, the insensitivity of the sliding mode controller cannot be ensured. One way to solve this problem is to employ the integral sliding-mode control scheme, such that the robustness of the system can be guaranteed throughout the entire response of the system starting from the initial time instant [35].

In order to facilitate the integral sliding-mode control design, the nonlinear system described in (6) can be rewritten in the following integral chain format aswhere .

By denoting as the desired trajectory of the quadrotor helicopter, the corresponding tracking error vector can be defined as

Then, with this tracking error vector (37), the integral sliding surface for the controlled system is defined as follows:where is the initial time instant and the diagonal matrices and represent the design parameters.

From this definition, one can observe that the integral term renders the sliding motion occur at the initial time instant . Accordingly, the system trajectory under integral-sliding mode control starts from the designed sliding surface, and the reaching phase is eliminated compared to conventional sliding mode control.

The continuous sliding-mode control part is designed by equalizing as

The discontinuous control part to reject disturbances is designed aswhere is a diagonal matrix constructed with positive high gains that make the designed sliding surface attractive, and the sat function is defined as [36]:with representing the boundary layer thickness.

However, in order to account for the unknown disturbances, the discontinuous control gain needs to be chosen greater than the upper bound of the unknown disturbances, which may lead to unexpected control chattering. Therefore, a nonlinear disturbance observer needs to be designed and synthesized with the designed sliding-mode control to reduce the discontinuous control gain.

3.4. Nonlinear Disturbance Observer Design and Synthesis with Sliding Mode Control

Assumption 4. The disturbances in system (36) are bounded and defined by .

Assumption 5. The lumped disturbances can be represented by the following exogenous system [37, 38]:To estimate the unknown disturbances, a nonlinear disturbance observer is designed asWith the estimated disturbances , the disturbance estimation error is defined as

Assumption 6. The disturbance estimation error is bounded by .
By recalling the sliding mode control derived in (39) and (40), with the estimated sensor faults and disturbances, the composite control law can be constructed as follows:

Theorem 2. Consider a nonlinear affine system (36) with exogenous disturbances (42). Given the designed integral sliding surface (38), by employing the disturbance estimation (43) and the feedback control law (45), the system tracking performance can be guaranteed as expected in the presence of unknown disturbances with the discontinuous control gain chosen as .

Proof of Theorem 2. To prove Theorem 2, a nonnegative Lyapunov function is defined asThe time derivative of for can be calculated asTherefore, the stability of the controller system can be guaranteed with the designed control law (45) in the presence of unknown exogenous disturbances.

Remark 1. Since the unknown disturbances have been precisely estimated by the disturbance observer, the magnitude of the estimation error can be kept much smaller than that of the disturbance. Thus, compared to conventional sliding-mode control, the value of the discontinuous control gain is significantly reduced, which can alleviate the control chattering problem to some extent.

4. Simulation Tests and Discussion

In this section, the proposed AFTC strategy against sensor faults and external disturbances will be validated. To achieve an effective evaluation of the proposed AFTC strategy, three different faulty patterns are considered for the attitude control system of the quadrotor helicopter. In addition, for comparison, the tracking performance of a conventional sliding-mode control is also investigated to demonstrate the advantages of the proposed control strategy.

It can be observed from Figures 35 that during and , all the attitude measurement systems fail simultaneously. By using the proposed sensor fault estimation scheme, the sensor faults can be accurately estimated, and the unbiased attitude estimation is provided for the feedback control. For comparison, the tracking performance of the compared conventional sliding-mode control without the sensor fault diagnosis system is studied, which is shown as the dash-dotted red line in Figures 68. In this case, the attitude measurements are directly utilized by the feedback controller. Therefore, the attitude of the quadrotor helicopter cannot follow the reference commands when there exist sensor faults, and the response of the quadrotor helicopter is obviously influenced by the wrong sensor measurements. For example, as shown in Figure 6, during , the reference command for the roll angle is zero, but the response is −1 deg due to the occurrence of sensor fault. In contrast, with the sensor diagnosis system, the sensor faults can be accurately estimated, and the quadrotor helicopter can still follow the reference commands very well even in the presence of sensor faults as can be observed from the dashed blue line of Figures 68.

In order to further test the capability of the proposed control strategy against both sensor faults and external disturbances, two different scenarios are tested. In scenario 1, in addition to the aforementioned sensor faults, at 5 s, a constant external disturbance with three different amplitudes is injected to roll, pitch, and yaw motions, respectively. The attitude tracking performances are demonstrated in Figures 911. It can be observed that, after the disturbance is injected to the roll, pitch, and yaw motion of the quadrotor helicopter at 5 s, even if there is no sensor fault at that time, there still exist attitude tracking errors with the compared control, as shown in the dash-dotted red line. However, with the proposed control, the injected external disturbances can be estimated and compensated accordingly. In this case, the desired attitude tracking performance can be maintained even in the presence of both sensor faults and constant external disturbances, as shown in the dashed blue line.

In scenario 2, a time-varying disturbance with three different amplitudes is injected to the quadrotor helicopter at 5 s to further validate the tracking performance of the proposed control strategy in the presence of both sensor faults and time-varying external disturbances. The corresponding attitude tracking performances are shown in Figures 1214. Compared to scenario 1, the system tracking performance with the compared control is more affected. On the contrary, even in this situation, the proposed control strategy can still maintain a satisfactory system tracking performance, which confirms the effectiveness and superiority of the proposed control strategy.

5. Conclusions

In this paper, an active fault-tolerant control strategy is proposed for a quadrotor helicopter against sensor faults and external disturbances. The proposed fault diagnosis scheme has the capability to accurately estimate the sensor faults and eliminate the effect of disturbances, which is then integrated with a robust controller in an active fashion to ensure the continuous operation of the quadrotor helicopter. For controlling the quadrotor helicopter, a disturbance observer is designed to effectively estimate the external disturbances and synthesized with the designed integral sliding-mode controller, which can help the baseline controller to avoid control chattering. In addition, the stability of the closed-loop system is theoretically proved. In comparison with a conventional sliding-mode control, the demonstrated numerical simulation results show the effectiveness and advantages of the proposed active fault-tolerant control strategy under different faulty and uncertain scenarios.

Data Availability

The data used to support the findings of this study are included within this article.

Conflicts of Interest

The authors declare that there are no conflicts of interest.

Acknowledgments

This research work was partially supported by the Fundamental Research Funds for the Central Universities.