Skip to main content
Sensors (Basel, Switzerland) logoLink to Sensors (Basel, Switzerland)
. 2022 Dec 20;23(1):34. doi: 10.3390/s23010034

Fault Estimation Method for Nonlinear Time-Delay System Based on Intermediate Observer-Application on Quadrotor Unmanned Aerial Vehicle

Qingnan Huang 1, Jingru Qi 1, Xisheng Dai 1, Qiqi Wu 1,*, Xianming Xie 1, Enze Zhang 1
Editor: Jiawei Xiang1
PMCID: PMC9824849  PMID: 36616631

Abstract

In this paper, the problem of actuator and sensor faults of a quadrotor unmanned aerial vehicle (QUAV) system is studied. In the system fault model, time delay, nonlinear term, and disturbances of QUAV during the flight are considered. A fault estimation algorithm based on an intermediate observer is proposed. To deal with a single actuator fault, an intermediate variable is introduced, and the intermediate observer is designed for the system to estimate fault. For simultaneous actuator and sensor faults, the system is first augmented, and then two intermediate variables are introduced, and an intermediate observer is designed for the augmented system to estimate the system state, faults, and disturbances. The Lyapunov–Krasovskii functional is used to prove that the estimation error system is uniformly eventually bounded. The simulation results verify the feasibility and effectiveness of the proposed fault estimation method.

Keywords: fault estimation, intermediate observer, quadrotor UAV, actuator fault, sensor fault

1. Introduction

QUAV is a special type of UAV system equipped with four propellers. It has unique advantages such as flexible control, small size, vertical take-off and landing, and strong adaptability. QUAVs have played a very important role in personnel rescue, military surveillance, vegetation protection, pesticide spraying, etc. [1,2,3,4,5]. However, with the improvement of system performance, the control system will become more complex. In the process of frequently performing tasks, various faults sometimes occur. The occurrence of QUAV system faults not only causes serious damage to the UAV itself but also poses a serious threat to human and environmental safety [6,7,8,9]. Therefore, as far as the current application of QUAV is concerned, strengthening the fault diagnosis and fault-tolerant control (FTC) of the system can effectively broaden the application field of quadrotor UAV and ensure the stability and safety of the system [10,11,12,13].

In terms of the control systems, fault diagnosis is significant, many scholars have devoted considerable attention to the research of fault diagnosis methods, which have made rapid development and achieved many theoretical results. These results have been successfully applied in various fields of industry, such as UAVs, high-speed trains, rolling bearings chemical plants, etc. At the same time, new theories and technologies are still emerging. According to traditional classification methods, model-based, data-based, and knowledge-based methods are three types of fault diagnosis methods [14,15,16]. In the field of QUAVs, with the increasing demand for system reliability, safety, and stability, the research on UAV fault diagnosis has progressed rapidly, among which actuator fault diagnosis has achieved the most results.

There are many methods for the actuator fault of QUAV. For example, Freddi et al. proposed a Thau observer-based fault diagnosis method for nonlinear systems, which can be used to detect an actuator fault or sensor fault, but their method is not suitable for fault isolation and estimation, and is only for UAV models [17]. For the QUAV attitude control system, the ref. [18] proposed a joint observer method, by decoupling the original system into two subsystems, where an adaptive observer and sliding mode observer were designed for the two subsystems, respectively, and achieved satisfactory results. For the QUAV system with external disturbance, Avram et al. introduced a nonlinear adaptive estimation technique to realize the detection, isolation, and adjustment of actuator fault [19]. Cen et al. proposed a new adaptive Thau observer that optimizes a robust fault diagnosis scheme and implements it on an actual QUAV [20]. In order to obtain the estimation of QUAV fault, an adaptive observer-based fault estimation algorithm was designed in ref. [21] and achieved good results.

Although extensive research efforts on the actuator fault of quadrotor UAVs, the existing research does not involve sensor fault diagnosis. Many approaches have been proposed in order to deal with the sensor fault of the QUAV. In view of the sensor fault in the measurement of the accelerometer and gyroscope of the QUAV, a sliding mode observer method was proposed in ref. [22] to estimate the roll and pitch angles of the UAV, and a nonlinear fault diagnosis algorithm to estimate sensor fault. Ref. [23] proposed a method for the detection and isolation of the sensor fault by designing an unknown input observer. However, this method is unable to estimate the sensor fault. For the nonlinear dynamic model of quadrotor UAV, a new scheme based on a neural network observer was designed in ref. [24] for UAV system sensor fault detection and isolation, this method can quickly detect sensor fault.

In addition to a single fault, the system may also have a simultaneous actuator fault and sensor fault. Therefore, there are many methods to cope with this condition. When actuator fault and sensor fault occur at the same time and the system contains unknown disturbance, the ref. [25] can achieve the function of estimating sensor fault by designing a robust sliding mode observer, but it can only be used to detect actuator fault and cannot estimate actuator fault. Ref. [26] proposed a new reduced-order sliding-mode observer, which can estimate the system state and faults, and achieve good estimation results. When the matching condition of the observer is not satisfied, ref. [27] first augmented the system and introduced a new state vector, then used an adaptive robust sliding mode observer to detect actuator and sensor faults. For nonlinear systems, an intermediate observer was proposed in ref. [28] for the first time, which broke through the constraints of the observer matching condition. Not only the single actuator fault can be estimated well, but also the actuator fault and sensor fault can be estimated effectively at the same time. However this paper ignores the influence of external disturbance, and in the design of the intermediate observer, the measurement output is not considered. In view of the problems in ref. [28], ref. [29] improved the results by considering the full measurement output in the design process of the state estimation observer. However, this design is not suitable for the case where the actuator and sensor fail at the same time, and it can only estimate the actuator fault. For a class of switched fuzzy systems, ref. [30] proposed a new switched fuzzy observer method by augmenting the system, which can simultaneously estimate actuator fault and sensor fault. It is shown that this method has a good estimation effect. In ref. [31], a special interval observer based on the zonotope method is proposed for the T-S fuzzy system, however, this method is only suitable for discrete-time systems, not for continuous-time systems.

In the actual quadrotor UAV system, the actuator and sensor may fail at the same time. In addition, the actual system will also have a time delay, which will sometimes affect the system’s stability. Based on the above reasons, a fault estimation strategy based on the intermediate observer is proposed in this paper to solve the fault estimation problem of a QUAV system with time delay and disturbances. The main contributions of this paper are as follows:

  • Different from the system model used in references [18,28], this paper considers the problem of a single actuator fault and simultaneous actuator and sensor faults with time delay.

  • For a single actuator fault, the effect of time delay is considered, an intermediate variable is introduced, and the intermediate observer is designed to estimate the state of the system and the actuator fault.

  • When actuator fault and sensor fault occur at the same time, we consider the influence of time delay, unknown input, and measurement noise disturbances in order to facilitate the handling of a sensor fault. The original system is augmented first, two intermediate variables are introduced, and the intermediate observer is designed for the augmented system, which is used to estimate the system state, actuator fault, sensor fault, and disturbances.

Notations. 

Some notations will be used in this article. Define Rn as the n-dimensional Euclidean space. For a matrix A, AT and A1 represent its transpose and inverse. Matrix I is an identity matrix of appropriate dimensions. · denotes the Euclidean norm of vectors or matrices. For a symmetric matrix A, A>0 means that the matrix is positive definite. The symbol * in the matrix represents the symmetric term. λmin(A) represents the smallest eigenvalue of the matrix A.

2. Design of the Intermediate Observer

2.1. Observer Design for Actuator Fault Diagnosis

The quadrotor UAV is an under-actuated system, which has six degrees of freedom but only four actual inputs. According to a large number of studies by scholars on the modeling of quadrotor UAVs, for the convenience of modeling, the following assumptions need to be made without loss of generality. First, the aircraft is a rigid body and the quality of the aircraft has a uniform distribution. Second, the aircraft’s lift surface and centre of gravity are in the same plane. Based on the above assumptions, ref. [18] established the following dynamics model of the quadrotor UAV attitude system:

Jxϕ¨=JyJzθ˙ψ˙+lKlcVrVlKafcxϕ˙2Jyθ¨=JzJxψ˙ϕ˙+lKlcVfVbKafcyθ˙2Jzψ¨=JxJyθ˙ϕ˙+KvcVf+Vb+KvnVr+VlKafczψ˙2 (1)

where Jx, Jy, Jz are the rotational inertia of the roll axis, pitch axis, and yaw axis, and the Euler angles of the body axes are Π=ϕ,θ,ψT that refer to roll, pitch, and yaw angles, respectively. Vf, Vb, Vr, Vl are the voltage of the front, rear, right, and left motors. l is the distance between the gravity centre of the quadrotor and the motor rotation axis, Klc represents the propeller force-thrust constant, Kvc and Kvn are the counter and normal rotation propeller torque–thrust constant. Kafcx, Kafcy, and Kafcz are the drag coefficients of the corresponding axis.

By defining the state vector xt=ϕϕ˙θθ˙ψψ˙T, output vector yt=ϕθψT, and control input vector ut=VfVbVrVlT, the quadrotor system is written in matrix form and can be expressed as

x˙t=Axt+But+gt,xtyt=Cxt (2)

Considering the case of a single actuator fault in a quadrotor UAV, in practical applications, the system will also have a time delay. Therefore, the following quadrotor UAV model with actuator fault and time delay is established:

x˙t=Axt+Azxtz+gt,xt+gzt,xtz+But+Efatyt=Cxt (3)

where xtRn is the system state vector, utRm donates the system input, and ytRl is the system output vector. A,Az,B,C, and E are real constant matrices of appropriate dimensions. E is full column rank. (A,B) and (A,C) are assumed to be controllable and observable, respectively. fatRr represents the actuator fault, zR is the time delay.

Some assumptions are as follows:

Assumption 1.

The actuator faults fat is unknown time-varying and satisfies f˙atα with α0, where α is a positive number.

Assumption 2.

The nonlinear vectors gt,xt and gt,xtz are assumed to be known and meet the Lipschitz condition about xtRn and xtzRn, gt,xtgt,x^tl1xtx^t, gzt,xtzgzt,x^tzl2xtzx^tz.

Assumption 3.

For every complex number λ with a non-negative real part, the following equalities hold:

rankAλIEC0=n+rankE (4)

Remark 1.

According to ref. [28], assumption 1 means that α could be unknown, and this assumption is more general. Assumption 2 is common because many actual nonlinear systems are Lipschitz.

Remark 2.

The intermediate observer used in this paper only needs to satisfy the condition that E is full column rank, which overcomes the restriction of the observer matching condition rank(CE)=rank(E). Assumption 3 guarantees that the invariant zero points of the system (A,C,E) are in the left half of the complex plane, and is common in the literature on fault estimation.

Lemma 1.

For any vector X,YRn, scalar ε>0, and positive definite matrix P, it holds that [32]:

2XTPYεXTPX+1εYTPY (5)

To design an intermediate observer for the nonlinear system (3), an intermediate variable is first introduced.

τt=fatσETxt (6)

From Equations (3) and (6), it can be obtained that

τ˙t=f˙atσETAxt+Azxtz+But+gt,xt+gzt,xtz+Efat (7)

Based on Equations (3) and (7), a fault estimation observer is proposed as follows:

x^˙t=Ax^t+Azx^tz+But+g^t,xt+g^zt,xtz+Ef^at+Fyy^ (8)
τ^˙t=σETEτ^tσETAx^t+Azx^tz+But+g^t,xt+g^zt,xtz+σEETx^t] (9)
y^t=Cx^t (10)
f^at=τ^t+σETx^t (11)

where x^t, y^t, f^at, and τ^t represent the estimation of xt, yt, fat, and τt, respectively. Define the estimation error ext=xtx^t, extz=xtzx^tz, eτt=τtτ^t, and efat=fatf^at, then

e˙xt=AFC+σEEText+Azextz+G+Gz+Eeτt (12)
e˙τt=f˙atσETEeτtσETA+σEEText+Azextz+G+Gz (13)

where G=gt,xtg^t,xt, Gz=gzt,xtzg^zt,xtz.

Theorem 1.

Under the above assumptions, for the given positive constants σ, ε, if there exist scalars δ>0 and matrices P>0, H such that

Ω=Ω11Ω12Ω13l1Pσδl1I00*Ω22Ω2300l2Pσδl2I**Ω330000***εI000****εI00*****εI0******εI<0 (14)

the estimation error system (12) and (13) is guaranteed to be uniformly ultimately bounded, and the estimator gain is given by F=P1H, where Ω11=PAHC+ATPCTHT+μPEET+μEETP+2εI+Q, Ω12=PAz, Ω13=PEσδATEσ2δEETE, Ω22=Q, Ω23=σδAzTE, Ω33=2σδETE+1εI+2εETE.

Proof. 

Consider the Lyapunov–Krasovskii functional as

V=V1+V2+V3 (15)

where

V1=exTtPext,V2=eτTtΓeτt,V3=tztexTsQexsds,Γ=δI.

Thus,

V˙1=exTtPAFC+AFCTPext+2σexTtPEEText+2exTtPEeτt+2exTtPAzextz+2exTtPG+2exTtPGz (16)
V˙2=2δeτTtf˙at2σδeτTtETEeτt2σδeτTtETA+σEEText2σδeτTtETAzextz2σδeτTtETG2σδeτTtETGz (17)
V˙3=exTtQextexTtzQextz (18)

According to Lemma 1, the following inequalities are always true:

2exTtPGεexTtext+1εl12exTtP2ext (19)
2exTtPGzεexTtext+1εl22exTtzP2extz (20)
2δeτTtf˙at1εeτTteτt+εδ2α2 (21)
2σδeτTtETGεeτTtETEeτt+1εl12δ2σ2exTtext (22)
2σδeτTtETGz1εl22δ2σ2exTtzextz+εeτTtETEeτt (23)

Define et=exTtexTtzeτTtT, then, it can be obtained that

V˙=eTΣe+κ (24)

where

Σ=Σ11Σ12Σ13*Σ22Σ23**Σ33

and

Σ11=PAFC+σEET+AFC+σEETTP+2εI+Q+1εl12P2+1εσ2δ2l12I
Σ12=PAzΣ13=PEσδATEσ2δEETEΣ22=Q+1εl22P2+1εσ2δ2l22IΣ23=σδAzTEΣ33=2σδETE+1εI+2εETEκ=εδ2α2

According to Schur’s complement theorem, Σ<0 is equivalent to Equation (14). If Σ<0, we can obtain that

V˙tλminΣeTtet+κ (25)

when λminΣet2>κ, then it is obvious that V˙<0. According to the Lyapunov stability theory, et is uniformly bounded and converges to a small set. The proof is complete. □

2.2. Observer Design for Actuator and Sensor Faults Diagnosis

For the case of simultaneous faults of quadrotor UAV actuator and sensor, the following quadrotor UAV model is established according to Equation (2), in which not only time delay is incorporated, but also unknown input disturbance and measurement noise disturbance of the UAV during the flight are considered.

x˙t=Axt+Azxtz+But+gt,xt+gzt,xtz+Efat+Ddtyt=Cxt+Ffst+D1ds(t) (26)

where xtRn is the system state vector, utRm donates the system input, ytRl is the system output vector. A, Az, B, C, D, D1, E, and F are real constant matrices of appropriate dimensions. D, D1, E, and F are all full column ranks. (A,B) and (A,C) are assumed to be controllable and observable, respectively. fatRr represents the actuator fault, fstRq is sensor fault, dtRp represents the unknown input disturbance, ds(t)Rs is the measurement noise disturbance, and zR is the time delay.

In addition, the following assumptions are introduced.

Assumption 4.

The sensor fault fst and disturbance dt, dst are unknown time-varying and satisfy f˙stβ with β0, d˙tω with ω0, d˙s(t)η with η0, where β, ω and η are positive numbers.

To facilitate estimating sensor fault, augmenting the original system (26), a new system is as follows:

x˙at=Aaxat+Azaxatz+Baut+ga+gza+Eafat+Dadt+Maξtyt=Caxat (27)

where

xat=xtdstfst,Aa=A00000000,Aza=Az00000000,Ba=B00,Ea=E00,
Da=D00,Ma=00I00I,ga=gt,xt00,gza=gzt,xtz00,
Ca=CD1F,ξ(t)=d˙s(t)f˙s(t).

Assumption 5.

For every complex number λ with a non-negative real part, the following two equalities hold:

rankAaλIEaCa0=n+q+s+rankEa (28)
rankAaλIDaCa0=n+q+s+rankDa (29)

To design an intermediate observer for the nonlinear system (27), we first introduce two intermediate variables.

τt=fatμEaTxat (30)
ζt=dtνDaTxat (31)

From (27), (30) and (31), we have

τ˙t=f˙atμEaTAaxat+Azaxatz+ga+gza+Baut+Eafat+Maξt+Dadt (32)
ζ˙t=d˙tνDaTAaxat+Azaxatz+ga+gza+Baut+Eafat+Maξt+Dadt (33)

Then, based on (27), (32) and (33), the intermediate estimator is constructed as follows:

x^˙at=Aax^at+Azax^atz+g^a+g^za+Baut+Eaf^at+Dad^t+Lyty^t (34)
τ^˙t=μEaTEaτ^tμEaTDaζ^tμEaTAax^at+Azax^atz+Baut+g^a+g^za+μEaEaTx^at+νDaDaTx^at (35)
ζ^˙t=νDaTEaτ^tνDaTDaζ^tνDaTAax^at+Azax^atz+Baut+g^a+g^za+μEaEaTx^at+νDaDaTx^at (36)
y^t=Cax^at (37)
f^at=τ^t+μEaTx^at (38)
d^t=ζ^t+νDaTx^at (39)
d^st=0I0x^at (40)
f^st=00Ix^at (41)

where x^at, y^t, f^at, f^st, τ^t, ζ^t, d^t, and d^st represent the estimation of xat, yt, fat, fst, τt, ζt, dt, and dst, respectively. Define the estimation errors exat=xatx^at, exatz=xatzx^atz, eτt=τtτ^t, eζt=ζtζ^t, efat=fatf^at, edt=dtd^t, and eds(t)=ds(t)d^s(t), then

e˙xat=AaLCa+μEaEaT+νDaDaTexat+Azaexatz+Ga+Gza+Eaeτt+Daeζt+Maξt (42)
e˙τt=f˙atμEaTEaeτtμEaTDaeζtμEaTAa+μEaEaT+νDaDaTexat+Azaexatz+Ga+Gza+Maξt (43)
e˙ζt=d˙tνDaTEaeτtνDaTDaeζtνDaTAa+μEaEaT+νDaDaTexat+Azaexatz+Ga+Gza+Maξt (44)

where Ga=gat,xatg^at,x^at, Gza=gzat,xatzg^zat,x^atz.

Theorem 2.

Suppose the above assumptions hold, for the given positive constants μ, ν, ε, if there exist scalars δ1>0, δ2>0, and matrices P>0, H such that

φ=φ11φ12φ13φ14l1PPMaμδ1l1Iμδ2l1I00000*φ22φ23φ240000l2Pμδ1l2Iμδ2l2I00**φ33φ340000000μδ1EaTMa0***φ4400000000μδ2DaTMa****εI00000000*****εI0000000******εI000000*******εI00000********εI0000*********εI000**********εI00***********εI0***********εI<0 (45)

the estimation error system (41)–(43) is guaranteed to be uniformly ultimately bounded. The estimator gain is given by L=P1H, where φ11=PAaHCa+AaTPCaTHT+μPEaEaT+μEaEaTP+νPDaDaT+νDaDaTP+2εI+Q, φ12=PAza, φ13=PEaμδ1AaTEaμ2δ1EaEaTEaμνδ1DaDaTEa, φ14=PDaνδ2AaTDaν2δ2DaDaTDaμνδ2EaEaTDa, φ22=Q, φ23=μδ1AzaTEa,φ24=νδ2AzaTDa, φ33=2μδ1EaTEa+1εI+2εEaTEa, φ34=μδ1EaTDaνδ2EaTDa, φ44=2νδ2DaTDa+1εI+2εDaTDa.

Proof. 

Consider the Lyapunov–Krasovskii functional as

V=V1+V2+V3+V4 (46)

where

V1=exaTtPexat,V2=eτTtΓ1eτt,V3=eζTtΓ2eζt,V4=tztexaTsQexasds,Γ1=δ1I,Γ2=δ2I.

Thus

V˙1=exaTtPAaLCa+μEaEaT+νDaDaT+AaLCa+μEaEaT+νDaDaTTPexat+2exaTtPAzaexatz+2exaTtPGa+2exaTtPGza+2exaTtPEaeτt+2exaTtPDaeζt+2exaTtPMaξt (47)
V˙2=2δ1eτTtf˙at2μδ1eτTtEaTEaeτt2μδ1eτTtEaTAa+μEaEaT+νDaDaTexat2μδ1eτTtEaTDaeζt2μδ1eτTtEaTMaξt2μδ1eτTtEaTGa2μδ1eτTtEaTGza2μδ1eτTtEaTAzaexatz (48)
V˙3=2δ2eζTtd˙t2νδ2eζTtDaTEaeτt2νδ2eζTtDaTAa+μEaEaT+νDaDaTexat2νδ2eζTtDaTDaeζt2νδ2eζTtDaTMaξt2νδ2eζTtDaTGa2νδ2eζTtDaTGza2νδ2eζTtDaTAzaexatz (49)
V˙4=exaTtQexatexaTtzQexatz (50)

According to Assumption 4, there exists a scalar γ>0 such that the following equation holds:

ξtγ (51)

Furthermore, the following inequalities always hold:

2exaTtPGa1εl12exaTtP2exat+εexaTtexat (52)
2exaTtPGzaεexaTtexat+1εl22exaTtzP2exatz (53)
2exaTtPMaξt1εexaTtPMaMaTPexat+εγ2 (54)
2δ1eτTtf˙at1εeτTteτt+εδ12α2 (55)
2μδ1eτTtEaTGaεeτTtEaTEaeτt+1εμ2δ12l22exaTtexat (56)
2μδ1eτTtEaTGzaεeτTtEaTEaeτt+1εμ2δ12l22exaTtzexatz (57)
2μδ1eτTtEaTMaξt1εμ2δ12eτTtEaTMaMaTEaeτt+εγ2 (58)
2δ2eζTtd˙t1εeζTteζt+εδ22ω2 (59)
2νδ2eζTtDaTGaεeζTtDaTDaeζt+1εν2δ22l12exaTtexat (60)
2νδ2eζTtDaTGzaεeζTtDaTDaeζt+1εν2δ22l22exaTtzexatz (61)
2νδ2eζTtDaTMaξt1εν2δ22eζTtDaTMaMaTDaeζt+εγ2 (62)

Define et=exaTtexaTtzeτTteζTtT, then, we can obtain that

V˙=etTΔet+κ (63)

where

Δ=Δ11Δ12Δ13Δ14*Δ22Δ23Δ24**Δ33Δ34***Δ44

and

Δ11=PAaLCa+μEaEaT+νDaDaT+AaLCa+μEaEaT+νDaDaTTP+1εν2δ22l12I+2εI+Q+1εl12P2+1εμ2δ12l12I+1εPMaMaTP
Δ12=PAza
Δ13=PEaμδ1AaTEaμ2δ1EaEaTEaμνδ1DaDaTEa
Δ14=PDaνδ2AaTDaν2δ2DaDaTDaμνδ2EaEaTDa
Δ22=Q+1εl22P2+1εμ2δ12l22I+1εν2δ22l22I
Δ23=μδ1AzaTEa
Δ24=νδ2AzaTDa
Δ33=2μδ1EaTEa+1εI+2εEaTEa+1εμ2δ12EaTMaMaTEa
Δ34=μδ1EaTDaνδ2EaTDa
Δ44=2νδ2DaTDa+1εI+2εDaTDa+1εν2δ22DaTMaMaTDa
κ=3εγ2+εδ12α2+εδ22ω2

According to Schur’s complement theorem, Δ<0 is equivalent to Equation (44). If Δ<0, we can obtain that

V˙tλminΔetTet+κ (64)

when λminΔet2>κ, then it is obvious that V˙<0. According to the Lyapunov stability theory, et is uniformly bounded and converges to a small set. The proof is complete. □

3. Simulation Results

The parameters of the QUAV system can be obtained from ref. [18] as shown in Table 1 so that the following matrix can be obtained as the model matrix of the quadrotor UAV system.

A=010000000000000100000000000001000000,B=0000000.42390.423900000.42390.42390000000.03270.03270.03270.0327,
C=100000001000000010,gt,xt=00.9928x4tx6t0.1449x22t00.9928x2tx6t0.1449x42t00.0827x62t.

Table 1.

QUAV system parameters.

Parameters Value Unit
Kvc 0.0036 N·m/V
Kvn 0.0036 N·m/V
Kafcx 0.008 N·m·s2
Kafcy 0.008 N·m·s2
Kafcz 0.0091 N·m·s2
Klc 0.1188 N·m/V
Jx 0.0552 kg·m2
Jy 0.0552 kg·m2
Jz 0.110 kg·m2
l 0.197 m

The nonlinear term with the time delay is as follows:

gt,xtz=02.9784x4tzx6tz0.4347x22tz02.9784x2tzx6t0.4347x42tz00.2481x62tz

3.1. Actuator Fault Simulation

Selecting the following matrix Az and actuator fault matrix E, the actuator fault is shown in Table 2.

Az=10.500000000100010.500010000000000.5000010,
E=010101T.

Table 2.

Actuator fault fat.

t [0 s, 5 s) [5 s, 20 s) [15 s, 20 s) [20 s, 25 s) [25 s, 30 s) [30 s, 40 s]
fat 0 0.1+0.1sin(0.7t) 0.15 0.01t 0.1 0

It can be seen that rank(CE)rank(E) and the observer matching condition is not satisfied. Selecting ε=1, σ=1.65, l1=l2=0.05, z = 0.5 s, 1 s, and 1.5 s. The initial condition is chosen as x0=0.1,0.1,0.1,0.1,0.1,0.1T. Solving (14), it can be obtained that

P=1037.75800.11520.21180.00570.57610.01450.11520.02660.00960.00460.01670.01970.21180.00967.37710.12140.16000.01010.00570.00460.12140.01620.00750.00310.57610.01670.16000.00757.88240.11820.01450.01970.01010.00310.11820.0218,
H=1061.11740.03790.07540.00020.00010.00010.03791.07730.03640.00030.00020.00030.07540.03641.12020.00010.00000.0002,
F=1030.21070.02990.06055.39392.35955.19980.02980.17880.02912.82622.48022.78520.06120.02960.21675.45212.54196.2169,
δ=1.0594.

In the process of system simulation, the choice of parameters is very important. The linear matrix inequalities solved by different σ are different, so the estimation effect will also be different. The choice of σ needs to be adjusted in the simulation process according to the estimation effect. In the process of adjusting the parameters, select an appropriate σ to obtain satisfactory estimation performance.

Figure 1 and Figure 2 show the actuator fault estimation and its estimation error with different time delays. The roll, pitch, yaw angles, and their estimations are shown in Figure 3 and Figure 4, which depict the estimation errors of states. From the simulation results, the method proposed in this paper can achieve a relatively accurate fault estimation effect, and its estimation error is within an acceptable range. It can be seen from Figure 3 and Figure 4 that the method proposed in this paper can accurately estimate the system state when the time delay z is 1 s.

Figure 1.

Figure 1

The actuator fault fat and its estimation f^at.

Figure 2.

Figure 2

The actuator fault estimation errors efa(t) when z = 0.5 s, 1 s, 1.5 s.

Figure 3.

Figure 3

The roll angle ϕ, pitch angle θ, yaw angle ψ, and their estimation ϕ^, θ^ and ψ^ when z = 1 s.

Figure 4.

Figure 4

The estimation errors of roll angle ϕ, pitch angle θ, and yaw angle ψ when z = 1 s.

3.2. Actuator and Sensor Faults Simulation

If choosing the output vector yt=ϕϕ˙θθ˙ψψ˙T, the matrix C can be obtained as

C=100000010000001000000100000010000001

Selecting the following matrix Az, the actuator fault matrix E, sensor fault matrix F, unknown input disturbance matrix D, and measurement noise disturbance matrix D1.

Az=00.100000000000000.100000000000000.1000000,
D=201022T,D1=101023T,E=2.52.80300T,F=011111T.

The actuator fault fat, sensor fault fst, unknown input disturbance dt, and measurement noise disturbance dst are created as Table 3.

Table 3.

Actuator fault fat, sensor fault fst, disturbance dt and dst.

t [0 s, 3 s) [3 s, 10 s) [10 s, 14 s) [14 s, 17 s) [17 s, 20 s) [20 s, 35 s]
fat 0 0.05+0.1sint 0.05 0.007t 0.03 0
t [0 s, 3 s) [3 s, 18 s) [18 s, 25 s) [25 s, 35 s]
fst 0 0.2sin(2t) 0.3 0
t [0 s, 3 s) [3 s, 10 s) [10 s, 18 s) [18 s, 35 s)
dt 0 0.1 0.006t 0
t [0 s, 3 s) [3 s, 18 s) [18 s, 30 s) [30 s, 35 s)
dst 0 0.01t 0.2 0

Selecting ε=1, μ=0.42, ν=0.52, l1=l2=0.01, z = 0.5 s, z = 1 s, and z = 1.5 s, the initial condition is chosen as x0=0.5,0,0.5,0,0.5,0T, and solving (45), it can be obtained that

P=140.025025.047188.298723.929269.159725.03570.70870.094325.0471142.537241.544680.435043.556043.19320.06801.819788.298741.5446624.568930.9302164.9707304.42320.76861.375323.929280.435030.9302135.967846.823442.09770.08171.851869.159743.5560164.970746.8234359.3018350.87341.25791.696625.035743.1932304.423242.0977350.8734445.85831.72961.76150.70870.06800.76860.08171.25791.72969.31410.07170.09431.81971.37531.85181.69661.76150.07178.8824,
H=567.641176.053199.8895258.8584144.7848231.0494123.2841368.663431.301286.9136164.8559159.888692.439030.0453411.7196387.585295.534045.2390216.3821118.7546330.7784366.747750.8788116.586954.382076.0824214.529967.1050264.272490.960938.369730.2844121.2659241.5669255.3811121.678921.44417.553237.947796.878120.8478108.497746.94713.920277.47016.543989.1012107.0822,
L=10.51903.45486.56077.93389.91157.64865.71076.34373.90505.70672.58114.65083.23150.74184.83382.14025.16192.86586.25555.35965.47667.06491.54574.51977.90111.781813.61598.334615.76238.49748.94702.787213.01739.399816.41819.47995.59501.83958.430513.78407.684414.86348.59153.20749.93262.481811.969914.6125,
δ1=15.4716,δ2=13.5147.

When the actuator and sensor of the quadrotor UAV system fail at the same time, considering the influence of time delay and disturbance, in order to obtain the estimated value of the fault and disturbance, two intermediate variables are introduced. Therefore, compared with the single actuator fault diagnosis, there is one more parameter here, and the selection of μ and ν should be adjusted during the simulation process to obtain a better estimation effect.

Through system simulation, when the time delays are 0.5 s, 1 s, and 1.5 s, respectively, the actuator fault fat, sensor fault fst, unknown input disturbance dt, measurement noise disturbance dt, and their estimated values f^at, f^st, d^t, and ds^t are shown in Figure 5, Figure 6, Figure 7 and Figure 8. Figure 9 presents the estimated errors for faults and disturbances, and the system states estimations are shown in Figure 10. Figure 11 depicts the estimation errors of states.

Figure 5.

Figure 5

The actuator fault fat and its estimation f^at.

Figure 6.

Figure 6

The sensor fault fst and its estimation f^st.

Figure 7.

Figure 7

The unknown input disturbance dt and its estimation d^t.

Figure 8.

Figure 8

The measurement noise disturbance dst and its estimation ds^t.

Figure 9.

Figure 9

The actuator fault, sensor fault, and disturbance estimation errors efa(t), efs(t), ed(t), and eds(t) when z = 1 s.

Figure 10.

Figure 10

The roll angle ϕ, pitch angle θ, yaw angle ψ, and their estimation ϕ^, θ^, and ψ^ when z = 1 s.

Figure 11.

Figure 11

The estimation errors of roll angle ϕ, pitch angle θ, and yaw angle ψ when z = 1 s.

From the simulation results, it can be seen that the algorithm can accurately estimate actuator fault, sensor fault, unknown input disturbance, and measurement noise disturbance under different time delays. From the estimation error curve, when the time delay is 1 s, the estimation errors of actuator fault, sensor fault, and disturbance are very small, all within the acceptable range. The roll angle, pitch angle, yaw angle, and their estimates are shown in Figure 10. The simulation results show that the observer method proposed in this paper can achieve good state estimation.

4. Conclusions

In this paper, a fault estimation observer is proposed for the nonlinear system of QUAV with time delay. Firstly, for a single actuator fault system, an intermediate variable is introduced, an intermediate observer is designed for the system, and the estimated value of the actuator fault can be obtained. Secondly, the influence of disturbances is considered, when the actuator and sensor fail at the same time, the original system is augmented, and then two intermediate variables are introduced to design a fault estimator for the augmented system, and the estimated value of the actuator fault, sensor fault, and disturbances can be obtained. Through system simulation results, the feasibility and effectiveness of the algorithm are verified. For the system, fault diagnosis is very important. On this basis, an appropriate FTC strategy should also be designed to compensate for the fault and maintain the stability of the system. Therefore, future work will consider the FTC of QUAV systems based on fault estimation results.

Author Contributions

Writing—original draft preparation and validation, Q.H.; writing—review and editing and methodology, J.Q.; visualization and software, X.D.; supervision, Q.W.; formal analysis and funding acquisition, X.X.; data curation, E.Z. All authors have read and agreed to the published version of the manuscript.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

Funding Statement

This research was funded by the National Natural Science Foundation of China (Grant No. 62161003); the Science and Technology Plan Projects of Liuzhou (Grant No. 2021AAF0103) and the Science and Technology Association Projects of Liuzhou (No. 20210104).

Footnotes

Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

References

  • 1.Zhang Y., Chamseddine A., Rabbath C.A., Gordon B.W., Su C.Y., Rakheja S., Fulford C., Apkarian J., Gosselin P. Development of advanced FDD and FTC techniques with application to an unmanned quadrotor helicopter testbed. J. Franklin Inst. 2013;350:2396–2422. doi: 10.1016/j.jfranklin.2013.01.009. [DOI] [Google Scholar]
  • 2.Mahony R., Kumar V., Corke P. Multirotor aerial vehicles: Modeling, estimation, and control of quadrotor. IEEE Rob. Autom. Mag. 2012;19:20–32. doi: 10.1109/MRA.2012.2206474. [DOI] [Google Scholar]
  • 3.Lotufo M.A., Colangelo L., Novara C. Control design for UAV quadrotors via embedded model control. IEEE Trans. Control Syst. Technol. 2019;28:1741–1756. doi: 10.1109/TCST.2019.2918750. [DOI] [Google Scholar]
  • 4.Radoglou-Grammatikis P., Sarigiannidis P., Lagkas T., Moscholios I. A compilation of UAV applications for precision agriculture. Comput. Netw. 2020;172:107148. doi: 10.1016/j.comnet.2020.107148. [DOI] [Google Scholar]
  • 5.Zohdi T.I. Multiple UAVs for mapping: A review of basic modeling, simulation and applications. Annu. Rev. Environ. Resour. 2018;43:523–543. doi: 10.1146/annurev-environ-102017-025912. [DOI] [Google Scholar]
  • 6.Abbaspour A., Aboutalebi P., Yen K.K., Sargolzaei A. Neural adaptive observer-based sensor and actuator fault detection in nonlinear systems: Application in UAV. ISA Trans. 2017;67:317–329. doi: 10.1016/j.isatra.2016.11.005. [DOI] [PubMed] [Google Scholar]
  • 7.Zhou L., Leng S., Liu Q., Wang Q. Intelligent UAV swarm cooperation for multiple targets tracking. IEEE Internet Things J. 2021;9:743–754. doi: 10.1109/JIOT.2021.3085673. [DOI] [Google Scholar]
  • 8.Dong X., Hua Y., Zhou Y., Ren Z., Zhong Y. Theory and experiment on formation-containment control of multiple multirotor unmanned aerial vehicle systems. IEEE Trans. Autom. Sci. Eng. 2018;16:229–240. doi: 10.1109/TASE.2018.2792327. [DOI] [Google Scholar]
  • 9.Ouyang J., Pan Y., Xu B., Lin M., Zhu W.P. Achieving Secrecy Energy Efficiency Fairness in UAV-Enabled Multi-User Communication Systems. IEEE Wirel. Commun. Lett. 2022;11:918–922. doi: 10.1109/LWC.2022.3149779. [DOI] [Google Scholar]
  • 10.Yu Z., Zhang Y., Jiang B., Yu X., Fu J., Jin Y., Chai T. Distributed adaptive fault-tolerant close formation flight control of multiple trailing fixed-wing UAVs. ISA Trans. 2020;106:181–199. doi: 10.1016/j.isatra.2020.07.005. [DOI] [PubMed] [Google Scholar]
  • 11.Nguyen N.P., Xuan Mung N., Hong S.K. Actuator fault detection and fault-tolerant control for hexacopter. Sensors. 2019;19:4721. doi: 10.3390/s19214721. [DOI] [PMC free article] [PubMed] [Google Scholar]
  • 12.Fourlas G.K., Karras G.C. A survey on fault diagnosis and fault-tolerant control methods for unmanned aerial vehicles. Machines. 2021;9:197. doi: 10.3390/machines9090197. [DOI] [Google Scholar]
  • 13.Tang P., Lin D., Zheng D., Fan S., Ye J. Observer based finite-time fault tolerant quadrotor attitude control with actuator faults. Aerosp. Sci. Technol. 2020;104:105968. doi: 10.1016/j.ast.2020.105968. [DOI] [Google Scholar]
  • 14.Willsky A.S. A survey of design methods for failure detection in dynamic systems. Automatica. 1976;12:601–611. doi: 10.1016/0005-1098(76)90041-8. [DOI] [Google Scholar]
  • 15.Hwang I., Kim S., Kim Y., Seah C.E. A survey of fault detection, isolation, and reconfiguration methods. IEEE Trans. Control Syst. Technol. 2009;18:636–653. doi: 10.1109/TCST.2009.2026285. [DOI] [Google Scholar]
  • 16.Gao Z., Cecati C., Ding S.X. A survey of fault diagnosis and fault-tolerant techniques—Part I: Fault diagnosis with model-based and signal-based approaches. IEEE Trans. Ind. Electron. 2015;62:3757–3767. doi: 10.1109/TIE.2015.2417501. [DOI] [Google Scholar]
  • 17.Freddi A., Longhi S., Monteriu A. A diagnostic thau observer for a class of unmanned vehicles. J. Intell. Rob. Syst. 2012;67:61–73. doi: 10.1007/s10846-012-9650-4. [DOI] [Google Scholar]
  • 18.Liu C., Jiang B., Zhang K. Incipient fault detection using an associated adaptive and sliding-mode observer for quadrotor helicopter attitude control systems. Circuits Syst. Signal Process. 2016;35:3555–3574. doi: 10.1007/s00034-015-0229-8. [DOI] [Google Scholar]
  • 19.Avram R.C., Zhang X., Muse J. Quadrotor actuator fault diagnosis and accommodation using nonlinear adaptive estimators. IEEE Trans. Control Syst. Technol. 2017;25:2219–2226. doi: 10.1109/TCST.2016.2640941. [DOI] [Google Scholar]
  • 20.Cen Z., Noura H., Susilo T.B., Younes Y.A. Robust fault diagnosis for quadrotor UAVs using adaptive Thau observer. J. Intell. Rob. Syst. 2014;73:573–588. doi: 10.1007/s10846-013-9921-8. [DOI] [Google Scholar]
  • 21.Chen F., Jiang R., Zhang K., Jiang B., Tao G. Robust backstepping sliding-mode control and observer-based fault estimation for a quadrotor UAV. IEEE Trans. Ind. Electron. 2016;63:5044–5056. doi: 10.1109/TIE.2016.2552151. [DOI] [Google Scholar]
  • 22.Avram R.C., Zhang X., Muse J. Quadrotor sensor fault diagnosis with experimental results. J. Intell. Rob. Syst. 2017;86:115–137. doi: 10.1007/s10846-016-0425-1. [DOI] [Google Scholar]
  • 23.Zarei J., Shokri E. Robust sensor fault detection based on nonlinear unknown input observer. Measurement. 2014;48:355–367. doi: 10.1016/j.measurement.2013.11.015. [DOI] [Google Scholar]
  • 24.Aboutalebi P., Abbaspour A., Forouzannezhad P., Sargolzaei A. A novel sensor fault detection in an unmanned quadrotor based on adaptive neural observer. J. Intell. Rob. Syst. 2018;90:473–484. doi: 10.1007/s10846-017-0690-7. [DOI] [Google Scholar]
  • 25.Yang J., Zhu F., Wang X., Bu X. Robust sliding-mode observer-based sensor fault estimation, actuator fault detection and isolation for uncertain nonlinear systems. Int. J. Control Autom. Syst. 2015;13:1037–1046. doi: 10.1007/s12555-014-0159-4. [DOI] [Google Scholar]
  • 26.Yang H., Yin S. Actuator and sensor fault estimation for time-delay Markov jump systems with application to wheeled mobile manipulators. IEEE Trans. Ind. Inf. 2019;16:3222–3232. doi: 10.1109/TII.2019.2915668. [DOI] [Google Scholar]
  • 27.Yang J., Zhu F. FDI design for uncertain nonlinear systems with both actuator and sensor faults. Asian J. Control. 2015;17:213–224. doi: 10.1002/asjc.867. [DOI] [Google Scholar]
  • 28.Zhu J.W., Yang G.H., Wang H., Wang F. Fault estimation for a class of nonlinear systems based on intermediate estimator. IEEE Trans. Autom. Control. 2015;61:2518–2524. doi: 10.1109/TAC.2015.2491898. [DOI] [Google Scholar]
  • 29.Li J., Huang S.J. Integrated observer based fault estimation for a class of Lipschitz nonlinear systems. Int. J. Robust Nonlinear Control. 2020;30:5678–5692. doi: 10.1002/rnc.5116. [DOI] [Google Scholar]
  • 30.Liu Y., Wang Y. Actuator and sensor fault estimation for discrete-time switched T–S fuzzy systems with time delay. J. Franklin Inst. 2021;358:1619–1634. doi: 10.1016/j.jfranklin.2020.11.015. [DOI] [Google Scholar]
  • 31.Zhu F., Tang Y., Wang Z. Interval-Observer-based fault detection and isolation design for TS fuzzy system based on zonotope analysis. IEEE Trans. Fuzzy Syst. 2021;30:945–955. doi: 10.1109/TFUZZ.2021.3050854. [DOI] [Google Scholar]
  • 32.Ha Q.P., Trinh H. State and input simultaneous estimation for a class of nonlinear systems. Automatica. 2004;40:1779–1785. doi: 10.1016/j.automatica.2004.05.012. [DOI] [Google Scholar]

Associated Data

This section collects any data citations, data availability statements, or supplementary materials included in this article.

Data Availability Statement

Not applicable.


Articles from Sensors (Basel, Switzerland) are provided here courtesy of Multidisciplinary Digital Publishing Institute (MDPI)

RESOURCES