Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing...

8
Detection of icing and actuators faults in the longitudinal dynamics of small UAVs using an LPV proportional integral unknown input observer Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen, Fatiha Nejjari and Vicenç Puig Abstract— This paper proposes a linear parameter varying proportional integral unknown input observer (PI-UIO) for the diagnosis of actuator faults and icing in unmanned aerial vehicles. It is shown that in presence of sensor noise, the proposed PI-UIO has the advantage of being affected by the noise, but not by its derivative. Another contribution of the paper is the introduction of an icing to wind/noise ratio, which allows performing an optimal tuning of some PI-UIO design parameters. Results obtained with a Zagi Flying Wing simulator are used to validate the effectiveness of the proposed approach. I. I NTRODUCTION The problem of fault detection and isolation is the problem of generating diagnostic signals sensitive to the occurrence of faults [1]. In recent years, this problem has attracted a lot of attention, and several approaches have been proposed as possible solutions, e.g. the geometric [1], [2] and the observer-based [3], [4] ones. Among the most significant faults that affect aviation safety, there is icing, i.e. the accretion of ice on aircraft wings and control surfaces [5]. By decreasing the lift and increasing the drag and the mass of the vehicle, icing has a profound impact on the aircraft performance, inducing a safety risk that can lead potentially to crashing [6]. When an aircraft flies through clouds at an ambient temperature below freezing, supercooled water droplets (SWD) suspended in the cloud can impact the aircraft surface and freeze immediately, thus accreting the ice [7]. The rate and the severity of icing are determined by several factors, such as shape and roughness of the impacting surface, vehicle speed, air temperature and relative humidity [8]. This work has been supported by a grant from Iceland, Liechtenstein and Norway through the EEA Financial Mechanism. Operated by Universi- dad Complutense de Madrid (ref. 006-ABEL-IM-2014B). The authors also acknowledge support by the Spanish Government (Ministerio de Economía y Competividad) and FEDER through the projects CICYT ECOCIS (ref. DPI2013-48243-C2-1-R) and CICYT HARCRICS (ref. DPI2014-58104-R), by AGAUR through the contract FI-DGR 2014 (ref. 2014FI_B1_00172), by the DGR of the Generalitat de Catalunya (ref. 2014/SGR/374) and by the Research Council of Norway through the Centres of Excellence funding scheme (ref. 223254 - NTNU AMOS). D. Rotondo and A. Cristofaro are also supported by the ERCIM Alain Bensoussan Fellowship programme. D. Rotondo, F. Nejjari and V. Puig are with Advanced Control Systems Group (SAC), Universitat Politècnica de Catalunya (UPC), TR11, Rambla de Sant Nebridi, 10, 08222 Terrassa, Spain. V. Puig is also with Institut de Robotica i Informatica Industrial (IRI), UPC-CSIC, Car- rer de Llorens i Artigas, 4-6, 08028 Barcelona, Spain. D. Rotondo, A. Cristofaro and T. A. Johansen are with Centre for Autonomous Marine Operations and Systems (NTNU AMOS), Department of Engineering Cy- bernetics, Norwegian University of Science and Technology, Norway. A. Cristofaro is also with School of Science and Technology, University of Camerino, via Madonna delle Carceri, 62302, Camerino, Italy. e-mail: damiano(dot)rotondo(at)yahoo(dot)it Recently, some anti- and de-icing systems for unmanned aerial vehicles (UAVs) have been proposed. For example, layers of coating material containing carbon nanotubes, that can be heated up quickly using an onboard energy source, have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes [10] with fast and accurate responses are needed for assuring high efficiency. The approaches recently applied to icing detection in aircrafts and UAVs include unknown input observers (UIOs) [11]–[13], adaptive multiple models [14] and statistical methods [15]. Furthermore, a linear parameter varying (LPV) UIO-based icing detection scheme has been presented in [16], with the main advantage of being consistent with the aircraft dynamics for a wide range of operating conditions. It is known that when noise affects the sensor measure- ments, proportional integral (PI) observers achieve better convergence and filtering properties [17]. For this reason, the study of PI-UIOs has attracted some interest, as tes- tified by the number of articles dealing with this subject, e.g. [18]–[20]. The goal of this paper is to improve the results obtained in [16], where the considered LPV UIO had only a proportional action. It is shown that when the sensor noise is included in the problem formulation, the estimation error dynamics obtained with [16] is affected by the noise derivative, which has a strong effect on the achievable performances, due to the high-frequency content of the noise signal. Even though the noise could be dealt with using low-pass filters, the optimal design and tuning of such filters would be a challenging problem, which motivates to seek alternative solutions for dealing with the noise within the observer design. For this reason, in order to overcome the limitation of the proportional UIO, an LPV PI-UIO is proposed. Moreover, another contribution of this work with respect to [16] is the introduction of an icing to wind/noise ratio (IWNR), which allows performing an optimal choice of some PI-UIO design parameters. The paper is structured as follows. Section II presents the quasi-LPV model of the UAV subject to icing and faults. Section III is dedicated to the design of an LPV PI-UIO for the actuator fault and icing diagnosis. Section IV validates the effectiveness of the proposed approach using a Zagi Flying Wing simulator. Finally, Section V outlines the main conclusions and suggests some future work.

Transcript of Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing...

Page 1: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

Detection of icing and actuators faults in the longitudinal dynamics ofsmall UAVs using an LPV proportional integral unknown input observer

Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen, Fatiha Nejjari and Vicenç Puig

Abstract— This paper proposes a linear parameter varyingproportional integral unknown input observer (PI-UIO) forthe diagnosis of actuator faults and icing in unmanned aerialvehicles. It is shown that in presence of sensor noise, theproposed PI-UIO has the advantage of being affected by thenoise, but not by its derivative. Another contribution of thepaper is the introduction of an icing to wind/noise ratio, whichallows performing an optimal tuning of some PI-UIO designparameters. Results obtained with a Zagi Flying Wing simulatorare used to validate the effectiveness of the proposed approach.

I. INTRODUCTION

The problem of fault detection and isolation is the problemof generating diagnostic signals sensitive to the occurrenceof faults [1]. In recent years, this problem has attracted alot of attention, and several approaches have been proposedas possible solutions, e.g. the geometric [1], [2] and theobserver-based [3], [4] ones.

Among the most significant faults that affect aviationsafety, there is icing, i.e. the accretion of ice on aircraft wingsand control surfaces [5]. By decreasing the lift and increasingthe drag and the mass of the vehicle, icing has a profoundimpact on the aircraft performance, inducing a safety risk thatcan lead potentially to crashing [6]. When an aircraft fliesthrough clouds at an ambient temperature below freezing,supercooled water droplets (SWD) suspended in the cloudcan impact the aircraft surface and freeze immediately, thusaccreting the ice [7]. The rate and the severity of icing aredetermined by several factors, such as shape and roughnessof the impacting surface, vehicle speed, air temperature andrelative humidity [8].

This work has been supported by a grant from Iceland, Liechtensteinand Norway through the EEA Financial Mechanism. Operated by Universi-dad Complutense de Madrid (ref. 006-ABEL-IM-2014B). The authors alsoacknowledge support by the Spanish Government (Ministerio de Economíay Competividad) and FEDER through the projects CICYT ECOCIS (ref.DPI2013-48243-C2-1-R) and CICYT HARCRICS (ref. DPI2014-58104-R),by AGAUR through the contract FI-DGR 2014 (ref. 2014FI_B1_00172), bythe DGR of the Generalitat de Catalunya (ref. 2014/SGR/374) and by theResearch Council of Norway through the Centres of Excellence fundingscheme (ref. 223254 - NTNU AMOS). D. Rotondo and A. Cristofaro arealso supported by the ERCIM Alain Bensoussan Fellowship programme.

D. Rotondo, F. Nejjari and V. Puig are with Advanced ControlSystems Group (SAC), Universitat Politècnica de Catalunya (UPC), TR11,Rambla de Sant Nebridi, 10, 08222 Terrassa, Spain. V. Puig is alsowith Institut de Robotica i Informatica Industrial (IRI), UPC-CSIC, Car-rer de Llorens i Artigas, 4-6, 08028 Barcelona, Spain. D. Rotondo, A.Cristofaro and T. A. Johansen are with Centre for Autonomous MarineOperations and Systems (NTNU AMOS), Department of Engineering Cy-bernetics, Norwegian University of Science and Technology, Norway. A.Cristofaro is also with School of Science and Technology, University ofCamerino, via Madonna delle Carceri, 62302, Camerino, Italy. e-mail:damiano(dot)rotondo(at)yahoo(dot)it

Recently, some anti- and de-icing systems for unmannedaerial vehicles (UAVs) have been proposed. For example,layers of coating material containing carbon nanotubes, thatcan be heated up quickly using an onboard energy source,have been used to paint the wing surfaces [9]. However,due to the large power consumption, fault/icing detectionschemes [10] with fast and accurate responses are neededfor assuring high efficiency. The approaches recently appliedto icing detection in aircrafts and UAVs include unknowninput observers (UIOs) [11]–[13], adaptive multiple models[14] and statistical methods [15]. Furthermore, a linearparameter varying (LPV) UIO-based icing detection schemehas been presented in [16], with the main advantage of beingconsistent with the aircraft dynamics for a wide range ofoperating conditions.

It is known that when noise affects the sensor measure-ments, proportional integral (PI) observers achieve betterconvergence and filtering properties [17]. For this reason,the study of PI-UIOs has attracted some interest, as tes-tified by the number of articles dealing with this subject,e.g. [18]–[20]. The goal of this paper is to improve theresults obtained in [16], where the considered LPV UIOhad only a proportional action. It is shown that when thesensor noise is included in the problem formulation, theestimation error dynamics obtained with [16] is affectedby the noise derivative, which has a strong effect on theachievable performances, due to the high-frequency contentof the noise signal. Even though the noise could be dealt withusing low-pass filters, the optimal design and tuning of suchfilters would be a challenging problem, which motivates toseek alternative solutions for dealing with the noise withinthe observer design. For this reason, in order to overcomethe limitation of the proportional UIO, an LPV PI-UIO isproposed. Moreover, another contribution of this work withrespect to [16] is the introduction of an icing to wind/noiseratio (IWNR), which allows performing an optimal choiceof some PI-UIO design parameters.

The paper is structured as follows. Section II presents thequasi-LPV model of the UAV subject to icing and faults.Section III is dedicated to the design of an LPV PI-UIO forthe actuator fault and icing diagnosis. Section IV validatesthe effectiveness of the proposed approach using a ZagiFlying Wing simulator. Finally, Section V outlines the mainconclusions and suggests some future work.

Page 2: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

II. QUASI-LPV MODEL OF THE UAV SUBJECT TOICING/FAULTS

Following [16], the longitudinal equations of motion ofan aircraft [21], under low-angle-of-attack condition, can bebrought to a quasi-LPV form using the nonlinear embeddingin the parameters approach [22], [23], as follows1 (see TableI for a description of the symbols):

x = A(u,w,q,θ)x+B(u,w)υ+d(θ) (1)

where x = (u,w,q,θ)T is the state vector, υ = (δ2t ,δe)

T is theinput vector, and the matrices A(u,w,q,θ), B(u,w), d(θ) aregiven by:

A(u,w,q,θ) =

a11(·) a12(·) a13(·) 0a21(·) a22(·) a23(·) 0a31(·) a32(·) a33(·) 0

0 0 1 0

(2)

B(u,w) =

b11 b12(·)0 b22(·)0 b32(·)0 0

d(θ) =

−gsinθ

gcosθ

00

(3)

where:

a11(·) =ρuS2m

[(CL0 +CLα

α)

sinα−(CD0 +CDα

α)

cosα−SpropCprop

S

]a12(·) =

ρwS2m

[(CL0 +CLα

α)

sinα−(CD0 +CDα

α)

cosα−SpropCprop

S

]a13(·) =−w+

ρScVa

4m

(CLq sinα−CDq cosα

)a21(·) =−

ρuS2m

[(CD0 +CDα

α)

sinα+(CL0 +CLα

α)

cosα]

a22(·) =−ρwS2m

[(CD0 +CDα

α)

sinα+(CL0 +CLα

α)

cosα]

a23(·) = u− ρScVa

4m

(CDq sinα+CLq cosα

)a31(·) =

ρScu2Jy

(Cm0 +Cmα

α)

a32(·) =ρScw2Jy

(Cm0 +Cmα

α)

a33(·) =ρVaSc2

4JyCmq

b11 =ρSpropCprop

2mk2

m

b12(·) =ρSV 2

a2m

(CLδe

sinα−CDδecosα

)b22(·) =−

ρV 2a S

2m

(CDδe

sinα+CLδecosα

)b32(·) =

ρV 2a Sc

2JyCmδe

Remark: It is worth highlighting that although (1) is in alinear form, it is an equivalent representation of the nonlinearequations that describe the longitudinal equations of motionof an aircraft (no linearization is performed).

1To ease the notation, the dependence of variables on time t is omitted.

TABLE ISYMBOLS DESCRIPTION

Symbol Descriptionu Horizontal velocity relative to the windw Vertical velocity relative to the windq Pitch rateθ Pitch angleg Gravitational accelerationρ Air densityS Wing surface aream Airframe massα Angle-of-attackc Mean aerodynamic chord of the wing

Sprop Area of the propellerkm Efficiency of the motorJy Element of the inertia matrixVa Airspeed with respect to the massδt Throttle deflectionCi Stability and control derivatives

A. Unknown inputs acting on the aircraft

The aircraft may be affected by undesired effects, suchas wind, actuator faults and accretion of ice on its surfaces(icing).

More specifically, the wind effect is modeled as an additivedisturbance vector W given by:

W =

−cosθ −sinθ

−sinθ cosθ

0 00 0

( ωxωz

)= H1(θ)ωx +H2(θ)ωz

(4)where ωx and ωz are the wind accelerations in the horizontaland vertical direction in the inertial frame, respectively. TheDryden model [24], which uses spatially varying stochasticprocesses with specified power spectral densities, is used torepresent the components of the wind gusts in a realistic way.

Actuator faults are represented as an unknown input termF given by:

F =

b11 b12(·)0 b22(·)0 b32(·)0 0

( ϕtϕe

)= B1ϕt +B2(u,w)ϕe (5)

where ϕt and ϕe correspond to faults in propellers/motorsand elevator, respectively.

Finally, the icing effect is modeled as an additive time-dependent disturbance E(u,w,q)η, where η is the icingseverity factor [25], and E(u,w,q) is given by [16]:

E(u,w,q) =(

E1(u,w,q) E2(u,w,q) E3(u,w,q) 0)T

(6)with:

E1(u,w,q) =ρV 2

a S2m

[(KL0CL0 +KLαCLα

α) sinα (7)

− (KD0CD0 +KDαCDα

α)cosα

+(KLqCLq sinα−KDqCDq cosα

) cq2Va

+(

KLδeCLδe

sinα−KDδeCDδe

cosα

)δe

]

Page 3: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

E2(u,w,q) =−ρV 2

a S2m

[(KD0CD0 +KDαCDα

α) sinα (8)

+(KL0CL0 +KLαCLα

α)cosα

+(KDqCDq sinα+KLqCLq cosα

) cq2Va

+(

KDδeCDδe

sinα+KLδeCLδe

cosα

)δe

]E3(u,w,q) =

ρV 2a Sc

2Jy(Km0Cm0 +Kmα

Cmαα (9)

+KmqCmq

cq2Va

+KmδeCmδe

δe

)where the coefficients Ki depend on aircraft design andoperating conditions [25].

The undesired effects are added as additive terms (un-known inputs) in the LPV state equation (1), modifying it asfollows:

x = A(u,w,q,θ)x+B(u,w)υ+Bun(u,w,q,θ)υun+d(θ) (10)

where υun = (ωx, ωz,ϕt ,ϕe,η)T is the unknown input vector,

and the matrix Bun(u,w,q,θ) is given by:

Bun(u,w,q,θ) = (H1(θ) H2(θ) B1 B2(u,w) E(u,w,q))(11)

Assuming that the UAV is equipped with airspeed mea-surement device (pitot tube), GPS and inertial sensors, allstate variables are supposed to be available and hence theoutput matrix of the system verifies C = I4×4.

III. ICING/FAULT DIAGNOSIS USING AN LPV PI-UIO

For further reasoning, let us rewrite (10) in a more generalform:

x = A(ϑ)x+B(ϑ)υ+Bun(ϑ)υun +d(ϑ) (12)

where ϑ is some varying parameter vector, containing ex-ogenous variables, endogenous variables (e.g. states and/orinputs), or a combination of them.

The output equation is given by:

y = x+ v (13)

where v is the measurement noise.It can be shown that, by using the proportional UIO

proposed in [16], the dynamics of the estimation error ε =x− x (with x denoting the state estimation provided by theUIO) would depend on the noise derivative v, which has astrong effect on the achievable performances, due to the high-frequency content of the noise signal. In order to overcomethis problem, an LPV PI-UIO is proposed, as stated in thefollowing theorem.

Theorem 1: Let R(ϑ), F(ϑ) and T (ϑ) be some givenmatrix functions, with det (R(ϑ)) 6= 0 and det (T (ϑ)) 6= 0∀ϑ ∈ Θ, where Θ is the set of possible values for ϑ, andcalculate the following matrix function:

K(ϑ) = T (ϑ)−1 [A(ϑ)+R(ϑ)−1 (R(ϑ)−F(ϑ)R(ϑ))]

(14)

where R(ϑ) is the time derivative of R(ϑ). Then, an UIO forthe system (12)-(13) is given by:

z = A(ϑ)z+B(ϑ)υ+d(ϑ)+A(ϑ)T (ϑ)w− T (ϑ)w (15)w = K(ϑ)(y− x) (16)x = z+T (ϑ)w (17)

where T (ϑ) is the time derivative of T (ϑ), with an estimationerror εR = R(ϑ)(x− x) that obeys:

εR = F(ϑ)εR +R(ϑ)Bun(ϑ)υun−R(ϑ)T (ϑ)K(ϑ)v (18)

Proof: The estimation error dynamics, taking into account(12) and (17), is given by:

εR = R(ϑ)(x− ˙x)+ R(ϑ)(x− x) = R(ϑ) [A(ϑ)x+B(ϑ)υ · · ·· · ·+Bun(ϑ)υun +d(θ)− z−T (ϑ)w− T (ϑ)w

]+ R(ϑ)(x− x)

(19)Considering now (15)-(17), (19) can be rewritten as:

εR =[R(ϑ)A(ϑ)−R(ϑ)T (ϑ)K(ϑ)+ R(ϑ)

](x− x) · · ·

· · ·+R(ϑ)Bun(ϑ)υun−R(ϑ)T (ϑ)K(ϑ)v(20)

Then, it is easy to see that (18) results from (20) takinginto account (14), which completes the proof. �

Remark 1: The rotation through the matrix R(ϑ) is neededin order to obtain a term of the form R(ϑ)Bun(ϑ) in theestimation error equation (18). As shown in the following,this term is of paramount importance in order to achieve theunknown input effect decoupling.

A. Unknown input effects decoupling

The matrix function R(ϑ) can be chosen to constrain therange of the matrix function R(ϑ)Bun(ϑ), in such a way thatdifferent output directions of the residuals are assigned towind disturbance, actuator faults and icing effects, respec-tively, with the aim of identifying the cause for some detectedsystem malfunctions. Even though a complete decouplingof the wind disturbance and icing effects from the actuatorfaults cannot be achieved due to the superposition of effectsand the lack of degrees of freedom in the UIO design, asuccessful fault/icing diagnosis can still be achieved.

To this aim, let us notice that as long as cosθ 6= 0, thefollowing condition holds:

E(u,w,q,θ) = E(t) ∈ span[

B1 B2(u,w) H2(θ)]∀t ≥ 0

(21)Then, the target is to design the UIO matrix function R(ϑ)

with the following properties:

R(ϑ)B1 = b11e1 (22)

R(ϑ)B2(u,w) =V 2a e2 (23)

R(ϑ)H2(θ) = cosθe3 (24)

where e1, e2, e3, e4 denote the canonical basis vectors ofR4. As discussed in the following subsection, together withan appropriate choice of the matrix function F(ϑ), (22)-(24)will assure that ϕt , ϕe and ωz will affect different componentsof the vector εR, i.e. εR,1, εR,2 and εR,3, respectively.

Page 4: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

It is easy to check that the following matrix satisfies (22)-(24):

R(u,w,θ) =

1 tanθ r13(u,w,θ) 00 0 2Jy

ρScCmδe

0

0 1 r33(u,w) 00 0 0 1

(25)

r13(u,w,θ) =Jy

mcCmδe

[(CDδe

+CLδetanθ

)cosα (26)

+(

CDδetanθ−CLδe

)sinα

]r33(u,w) =

Jy

mcCmδe

(CLδe

cosα+CDδesinα

)(27)

Due to the presence of cosα and sinα in r13(u,w,θ) andr33(u,w), the matrix function R(ϑ) will contain α, whichis affected by unknown faults and icing. However, theseelements can be assumed to be small in size, such that R(ϑ)can be approximated with the following matrix, obtainedfrom (25) assuming a constant α:

˜R(u,w,q,θ) =

0 ˜r12(q,θ) ˜r13(u,w,q,θ) 00 0 0 00 0 0 00 0 0 0

(28)

˜r12(q,θ) =q

cos2 θ(29)

˜r13(u,w,q,θ) =Jy

mcCmδe

(CLδe

cosα+CDδesinα

) qcos2 θ

(30)

B. Optimal choice of the matrix function F(ϑ)

The matrix function F(ϑ) can be chosen as desiredthrough an appropriate choice of the matrix K(ϑ), see (14),such that it is possible to assign the eigenvalues functionλ(·) : ϑ ∈ Θ 7→ λ(ϑ) ∈ R4. By choosing a diagonal matrixfunction F(ϑ):

F(ϑ) =

λF

1 (ϑ) 0 0 00 λF

2 (ϑ) 0 00 0 λF

3 (ϑ) 00 0 0 λF

4 (ϑ)

(31)

some desired properties are obtained. First of all, the con-vergence to zero of the estimation error εR when νun = 0and v = 0 can be obtained by constraining λF

i (ϑ) ∈ C−∀ϑ∈Θ. This is advantageous with respect to the case of fullF(ϑ), where the stability should be proved using an LMI-based Lyapunov approach [26]. Second, the eigenvalues ofF(ϑ) will correspond to e1, e2, e3, e4, i.e. F(ϑ)ei = λF

i (ϑ),i = 1,2,3,4, such that it will be assured that ϕt , ϕe and ωzwill affect only εR,1, εR,2 and εR,3, respectively, thanks to theunknown input effects decoupling discussed previously.

At this point, it remains to tune the matrix functionsλF

i (ϑ), i = 1,2,3,4, in some optimal way. To do so, let usintroduce the icing to wind/noise ratio (IWNR) for the i-thresidual εR,i, as follows:

IWNRi(·) =

∣∣∣ ε∞R,i,ηη

∣∣∣∣∣∣ ωMAXxωx

ε∞R,i,ωx

∣∣∣+ ∣∣∣ ωMAXzωz

ε∞R,i,ωz

∣∣∣+ 3∑j=1

∣∣∣∣ vMAXjv j

ε∞R,i,v j

∣∣∣∣(32)

where ε∞R,i,η, ε∞

R,i,ωx, ε∞

R,i,ωzand ε∞

R,i,v jare the contributions

to the steady-state value of εR,i due to the icing, the windaccelerations ωx/ωz and the j-th sensor noise, respectively.Notice that a scalar factor is added to weigh the contributionsto ε∞

R,i brought by the different sources of perturbation in thesame way.

From the estimation error dynamics given by (18), ap-plied to the LPV model of the UAV subject to icing/faultsdescribed in Section II, taking into account (25)-(31), andafter some calculation, the following is obtained:

ε∞R,1,η =−

(E1(u,w,q)+ tanθE2(u,w,q)+ r13(u,w,θ)E3(u,w,q)

λF1 (ϑ)

(33)

ε∞R,1,ωx =

cosθ+ sinθ tanθ

λF1 (ϑ)

ωx (34)

ε∞R,1,ωz =0 (35)

ε∞R,1,v1

=

(a11(·)+a21(·) tanθ+ r13(u,w,θ)a31(·)

λF1 (ϑ)

−1)

v1 (36)

ε∞R,1,v2

=

(a12(·)+a22(·) tanθ+ r13(u,w,θ)a32(·)

λF1 (ϑ)

)v2 (37)

+

( ˜r12(q,θ)λF

1 (ϑ)− tanθ

)v2

ε∞R,1,v3

=

(a13(·)+a23(·) tanθ+ r13(u,w,θ)a33(·)

λF1 (ϑ)

)v3 (38)

+

( ˜r13(u,w,q,θ)λF

1 (ϑ)− r13(u,w,θ)

)v3

ε∞R,2,η =− r23

λF2 (ϑ)

E3(u,w,q)η (39)

ε∞R,2,ωx = 0 (40)

ε∞R,2,ωz = 0 (41)

ε∞R,2,v1

=r23a31(·)

λF2 (ϑ)

v1 (42)

ε∞R,2,v2

=r23a32(·)

λF2 (ϑ)

v2 (43)

ε∞R,2,v3

=

(r23a33(·)

λF2 (ϑ)

− r23

)v3 (44)

ε∞R,3,η =−

(E2(u,w,q)+ r33(u,w)E3(u,w,q)

λF3 (ϑ)

)η (45)

ε∞R,3,ωx =

sinθ

λF3 (ϑ)

ωx (46)

ε∞R,3,ωz =−

cosθ

λF3 (ϑ)

ωz (47)

ε∞R,3,v1

=

(a21(·)+ r33(u,w)a31(·)

λF3 (ϑ)

)v1 (48)

ε∞R,3,v2

=

(a22(·)+ r33(u,w)a32(·)

λF3 (ϑ)

−1)

v2 (49)

ε∞R,3,v3

=

(a23(·)+ r33(u,w)a33(·)

λF3 (ϑ)

− r33(u,w))

v3 (50)

Hence, it is evident that the icing to wind/noise ratio forthe i-th residual, defined in (32), depends on ϑ due to theeigenvalue λi(ϑ) and the presence of the state variables,

Page 5: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

which are included in ϑ. In order to enhance the residual’sability to reject the wind acceleration disturbance and thenoise, and to increase the sensitivity to the icing, an optimalchoice of λF

i (ϑ) would be the one that maximizes thecorresponding icing to wind/noise ratio2, i.e.

λFi,OPT (ϑ) = arg max

λFi (ϑ)<0

IWNRi(ϑ,λF

i (ϑ))

(51)

The optimization problem (51) corresponds to an infinitenumber of constraints, which can be reduced to a finitenumber by gridding the set Θ, and calculating (51) for eachpoint of this grid. Then, for a given value of ϑ, the matrixF(ϑ) would be calculated as a weighted convex combinationof the nearby gridding points. In this way, the convergence tozero of the estimation error εR when νun = 0 and v= 0 wouldstill be guaranteed, due to the fact that a convex combinationof negative definite diagonal matrices would preserve theproperty of being negative definite diagonal. On the otherhand, even though the optimality of the eigenvalues withrespect to the icing to wind/noise ratio would be guaranteedonly at the gridding points, it is reasonable that if the grid issufficiently dense, the sub-optimality for values of ϑ differentfrom the grid ones would be only a slight degradation withrespect to the optimality.

C. Fault/icing diagnosis algorithm

The following algorithm is proposed to decide about theoccurrence of faults and icing.

Decision Algorithm.

if∣∣εR,1(t)

∣∣≤ εthR,1 ∧

∣∣εR,2(t)∣∣≤ εth

R,2 ∧∣∣εR,3(t)

∣∣≤ εthR,3

then “no faults/no icing”

if∣∣εR,1(t)

∣∣> εthR,1 ∧

∣∣εR,2(t)∣∣≤ εth

R,2 ∧∣∣εR,3(t)

∣∣≤ εthR,3

then “fault in thrust”

if∣∣εR,1(t)

∣∣≤ εthR,1 ∧

∣∣εR,2(t)∣∣> εth

R,2 ∧∣∣εR,3(t)

∣∣≤ εthR,3

then “fault in elevator”

else “possible icing”

The thresholds εthR,1, εth

R,2, εthR,3 should be calculated in such

a way that the residuals never exceed them due to the windturbulence.

IV. CASE STUDY

Let us consider the case study of a small UAV (Zagi FlyingWing, see Table II for the parameters appearing in the quasi-LPV model described in Section II) flying at an altitudeh = 150m and subject to wind accelerations calculated usingthe Dryden model provided by the Aerospace Toolbox ofMATLAB, with a light probability of exceedance of high-altitude intensity.

The aircraft is controlled by an autopilot, responsible ofmaintaining the horizontal velocity u around the desired

2Notice that the proposed approach is akin to the H−/H∞ fault detectionobserver design described in [27].

TABLE IISYSTEM PARAMETERS VALUES

Param. Value Param. Value Param. Valuem 1.56kg CL0 0.09167 CDq 0Jy 0.0576kgm2 CD0 0.01631 Cmq −1.3990S 0.2589m2 Cm0 −0.02338 CLδe

0.2724c 0.3302m CLα

3.5016 CDδe0.3045

Sprop 0.0314m2 CDα0.2108 Cmδe

−0.3254ρ 1.2682kg/m3 Cmα

−0.5675 Cprop 1.0km 20 CLq 2.8932

value ure f = 20m/s with the following reference pitch angle:

θre f =

0 t ≤ 100s

(t−100)1500 100s < t ≤ 250s

(450−t)2000 250s < t ≤ 450s0 t > 450s

(52)

It is assumed that the noise affecting the sensor measure-ments in (13) is uniformly distributed within the followingintervals: v1 ∈ [−1,1], v2 ∈ [−1,1], v3 ∈ [−0.001,0.001],v4 ∈ [−0.008,0.012].

Three different fault scenarios have been considered, asfollows:

A. Fault scenario 1 (FS1)

The effective thrust input δt is subject to a loss ofefficiency with respect to its nominal value δ∗t :

δt(t) = 0.7δ∗t (t) (53)

The fault is linearly incipient, such that the loss of efficiencystarts at time t = 200s and equals (53) from time t = 210s.

B. Fault scenario 2 (FS2)

The effective elevator deflection δe is subject to a loss ofefficiency with respect to its nominal value δ∗e :

δe(t) = 0.9δ∗e(t) (54)

The fault is linearly incipient, such that the loss of efficiencystarts at time t = 200s and equals (54) starting from timet = 210s.

C. Fault scenario 3 (FS3)

The aircraft is subject to icing, modeled as in (6)-(9),taking into account the coefficients Ki listed in Table III. Theicing starts at time t = 200s and slowly increases η from 0to 0.2, such that η = 0.2 starting from time t = 400s.

The optimization problem (51) has been solved in 1296gridding points, that correspond to the partition of eachinterval of variation of the state variables (u ∈ [15,25],w ∈ [1,5], q ∈ [−0.001,0.001], θ ∈ [−0.01,0.01]) in 5 sub-intervals, providing the optimal values for the eigenvaluesλF

i (ϑ), i = 1,2,3, that are shown in Fig. 1 (due to thedifference in order of magnitude of the optimal values forthe eigenvalues, a logarithmic scale is used for presentationpurpose).

Remark: Notice that the optimization of F(ϑ), which isthe most computationally demanding part of the proposed

Page 6: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

TABLE IIICOEFFICIENTS Ki FOR AN ALL ICED CONFIGURATION

Coeff. Value Coeff. Value Coeff. ValueKL0 0 KLα

−0.5000 KLq −0.0675KLδe

−0.4770 KD0 2.5610 KDα0

KDq 0 KDδe0 Km0 0

Kmα−0.4960 Kmq −0.1755 Kmδe

−0.5000

0 200 400 600 800 1000 1200−3

−2.5

−2

−1.5

−1

−0.5

0

0.5

1

Gridding point ϑ

Eig

enva

lue

Log 10

(−λ i(ϑ

))

Log10

(−λ1F(ϑ))

Log10

(−λ2F(ϑ))

Log10

(−λ3F(ϑ))

Fig. 1. Optimal eigenvalues at the gridding points (logarithmic scale).

strategy, is performed offline. Only the weighted combinationof the matrices defined at the gridding points is performedonline, taking into account the value of the varying parametervector.

Figs. 2-4 show the residuals obtained in the consideredfault scenarios using a proportional UIO, as described in[16]. On the other hand, Figs. 5-7 show the evolution ofthe residuals obtained using the proposed PI-UIO. From aqualitative comparison between the results, it is evident thatthe latter exhibits a stronger rejection of the undesired effects,i.e. sensor noise and wind acceleration disturbance.

It has been noticed that the frequency content of theresiduals εR,i(t), i = 1,2,3, changes under faults/icing oc-currence. In fact, in absence of faults/icing, the residuals areexcited only by the wind acceleration, which is mostly ahigh frequency disturbance. On the other hand, the actuatorfaults and icing effects increase the low frequency contentof the variables εR,i(t). Thus, low-pass filtering the residualsindicates more clearly the presence of faults/icing. Morespecifically, the low-pass filtered residuals are obtained asfollows:

φR,i(t) =−aiφR,i(t)+aiεR,i(t) i = 1,2,3 (55)

where ai is a design parameter that should be chosen toguarantee that only the part of the frequency spectrum ofεR,i(t) affected by faults/icing is preserved. Then, the deci-sion algorithm proposed in the previous section is slightlymodified by replacing all instances of εR,i with φR,i, i =1,2,3.

Figs. 8-10 show the evolution of the low-pass filtered

0 100 200 300 400 500−3

−2.5

−2

−1.5

−1

−0.5

0

0.5

1

1.5

2

t (s)

ε 1(t)

FS1FS2FS3

Fig. 2. Residual ε1(t) using a proportional UIO.

0 100 200 300 400 500−4

−2

0

2

4

6

8

10

12

14

t (s)

ε 2(t)

FS1FS2FS3

Fig. 3. Residual ε2(t) using a proportional UIO.

residuals, obtained using the proposed PI-UIO and (55) withai = 0.01, in the considered fault scenarios.

Concerning the fault/icing diagnosis, it can be seen thatin fault scenario 1 (fault in the thrust), the only residualthat differs considerably from 0 after t = 200s is φR,1(t). Onthe other hand, in fault scenario 2 (fault in the elevator), theresidual which exhibits an increase of its value after t = 200sis φR,2. Finally, under icing occurrence all the residualsincrease their values considerably. According to the decisionalgorithm proposed in the previous section, once appropriatethresholds for the residuals have been chosen, the occurrenceof faults/icing can be detected and isolated successfully,proving the effectiveness of the proposed approach.

V. CONCLUSIONS

This paper has proposed a linear parameter varying (LPV)proportional integral unknown input observer (PI-UIO) forfault/icing detection in unmanned aerial vehicles (UAVs).The advantage of the proposed LPV PI-UIO is that it can

Page 7: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

0 100 200 300 400 500−1

−0.5

0

0.5

1

1.5

2

2.5

3

3.5

t (s)

ε 3(t)

FS1FS2FS3

Fig. 4. Residual ε3(t) using a proportional UIO.

0 100 200 300 400 500−350

−300

−250

−200

−150

−100

−50

0

t (s)

ε R,1

(t)

FS1FS2FS3

Fig. 5. Residual εR,1(t) using the proposed proportional integral UIO.

take into account operating point variations in an elegantway using the LPV paradigm. Moreover, the presence of theintegral term avoids the appearance of the noise derivativeterm in the estimation error equation, thus increasing thenoise rejection properties. It has been shown how an optimaldesign of the PI-UIO may be performed by increasing thesensitivity to icing, while decreasing the sensitivity to windacceleration disturbance and noise, through the introductionof the icing to wind/noise ratio (IWNR).

The case study of a Zagi Flying Wing UAV has shownthe effectiveness of the decision algorithm, which identifiescorrectly unexpected changes in the system dynamics dueto actuator faults or icing, using low-pass filtered residualsobtained from the proposed PI-UIO.

Future research will extend the results to a 9-DOF aircraftmodel, and will include parametric uncertainty in the model,in order to perform a robust fault/icing diagnosis.

0 100 200 300 400 500−5

0

5

10

15

20

25

30

t (s)

ε R,2

(t)

FS1FS2FS3

Fig. 6. Residual εR,2(t) using the proposed proportional integral UIO.

0 100 200 300 400 500−10

−5

0

5

10

15

20

25

t (s)

ε R,3

(t)

FS1FS2FS3

Fig. 7. Residual εR,3(t) using the proposed proportional integral UIO.

REFERENCES

[1] C. De Persis and A. Isidori, “A geometric approach to nonlinear faultdetection and isolation,” IEEE Transactions on Automatic Control,vol. 46, no. 6, pp. 853–865, 2001.

[2] C. De Persis, R. De Santis, and A. Isidori, “Nonlinear actuator faultdetection and isolation for a VTOL aircraft,” in Proceedings of theAmerican Control Conference, 2001, pp. 4449–4454.

[3] P. Kaboré, S. Othmar, T. F. McKenna, and H. Hammouri, “Observer-based fault diagnosis for a class of non-linear systems - Applicationto a free radical copolymerization,” International Journal of Control,vol. 73, no. 9, pp. 787–803, 2000.

[4] P. Kaboré and H. Wang, “Design of fault diagnosis filters and fault-tolerant control for a class of nonlinear systems,” IEEE Transactionson Automatic Control, vol. 46, no. 11, pp. 1805–1810, 2001.

[5] F. Caliskan and C. Hajijev, “A review of in-flight detection andidentification of aircraft icing and reconfigurable control,” Progressin Aerospace Sciences, vol. 60, pp. 12–34, 2013.

[6] R. Gent, N. Dart, and J. Cansdale, “Aircraft icing,” Phil. Trans. ofthe Royal Soc. of London. Series A: Mathematical, Physical andEngineering Sciences, vol. 358, pp. 2873–2911, 2000.

[7] J. W. Elliott and F. T. Smith, “Ice formation on a smooth or rough coldsurface due to the impact of a supercooled water droplet,” Journal ofEngineering Mathematics, pp. 1–30, 2015.

Page 8: Damiano Rotondo, Andrea Cristofaro, Tor Arne Johansen ......have been used to paint the wing surfaces [9]. However, due to the large power consumption, fault/icing detection schemes

0 100 200 300 400 500−350

−300

−250

−200

−150

−100

−50

0

t (s)

φ R,1

(t)

FS1FS2FS3

Fig. 8. Low-pass filtered residual φR,1(t) using the proposed PI-UIO.

0 100 200 300 400 500−0.2

0

0.2

0.4

0.6

0.8

1

1.2

1.4

1.6

1.8

t (s)

φ R,2

(t)

FS1FS2FS3

Fig. 9. Low-pass filtered residual φR,2(t) using the proposed PI-UIO.

[8] M. B. Bragg, A. P. Broeren, and L. Blumenthal, “Iced-airfoil aerody-namics,” Progress in Aerospace Sciences, vol. 41, no. 5, pp. 323–362,2005.

[9] K. L. Sørensen, A. S. Helland, and T. A. Johansen, “Carbonnanomaterial-based wing temperature control system for in-flight anti-icing and de-icing of unmanned aerial vehicles,” in Proceedings of theIEEE Aerospace Conference, 2015.

[10] C. Hajijev and F. Caliskan, Fault diagnosis and reconfiguration inflight control systems. Springer Science and Business Media, 2003.

[11] M. Tousi and K. Khorasani, “Robust observer-based fault diagnosis foran unmanned aerial vehicle,” in Proceedings of the IEEE InternationalSystems Conference (SysCon), 2011, pp. 428–434.

[12] A. Cristofaro and T. A. Johansen, “An unknown input observer ap-proach to icing detection for unmanned aerial vehicles with linearizedlongitudinal motion,” in American Control Conference, 2015.

[13] M. M. Seron, T. A. Johansen, J. A. De Doná, and A. Cristofaro,“Detection and estimation of icing in unmanned aerial vehicles usinga bank of unknown input observers,” in Proceedings of the 5thAustralian Control Conference (UACC), 2015, pp. 87–92.

[14] A. Cristofaro and T. A. Johansen, “Icing detection and identificationfor unmanned aerial vehicles: multiple model adaptive estimation,” inEuropean Control Conference, 2015.

[15] K. L. Sørensen, M. Blanke, and T. A. Johansen, “Diagnosis of windicing through lift and drag coefficient change detection for smallunmanned aircraft,” in Proc. 9th IFAC Symposium on Fault Detection,

0 100 200 300 400 500−2

0

2

4

6

8

10

12

14

t (s)

φ R,3

(t)

FS1FS2FS3

Fig. 10. Low-pass filtered residual φR,3(t) using the proposed PI-UIO.

Supervision and Safety of Technical Processes, 2015.[16] D. Rotondo, A. Cristofaro, T. A. Johansen, F. Nejjari, and V. Puig,

“Icing detection in unmanned aerial vehicles with longitudinal motionusing an LPV unknown input observer,” in 9th IEEE Multi-Conferenceon Systems and Control, 2015.

[17] K. K. Busawon and P. Kabore, “On the design of integral and pro-portional integral observers,” in Proceedings of the American ControlConference, 2000, pp. 3725–3729.

[18] D. Koenig and S. Mammar, “Design of proportional-integral observersfor unknown input descriptor systems,” IEEE Transactions on Auto-matic Control, vol. 47, no. 12, pp. 2057–2062, 2002.

[19] D. Koenig, “Unknown input proportional multiple-integral observerdesign for linear descriptor systems: application to state and faultestimation,” IEEE Transactions on Automatic Control, vol. 50, no. 2,pp. 212–217, 2005.

[20] T. Youssef, M. Chadli, H. R. Karimi, and M. Zelmat, “Design ofunknown inputs proportional integral observers for TS fuzzy models,”Neurocomputing, vol. 123, pp. 156–165, 2014.

[21] R. W. Beard and T. W. McLain, Small Unmanned Aircraft: Theoryand Practice. Princeton, NJ, USA: Princeton University Press, 2012.

[22] A. Kwiatkowski, M.-T. Boll, and H. Werner, “Automated Generationand Assessment of Affine LPV Models,” in Proceedings of the 45thIEEE Conference on Decision and Control, 2006, pp. 6690–6695.

[23] D. Rotondo, V. Puig, F. Nejjari, and M. Witczak, “Automated gen-eration and comparison of Takagi-Sugeno and polytopic quasi-LPVmodels,” Fuzzy Sets and Systems, vol. in press, 2015.

[24] F. M. Hoblit, Gust loads on aircraft: concept and applications. Wash-ington, DC, USA: American Institute of Aeronautics and Astronautics,1988.

[25] M. B. Bragg, T. Hutchinson, J. Merret, R. Oltman, and D. Pokhariyal,“Effect of ice accretion on aircraft flight dynamics,” in Proceedingsof the 38th AIAA Aerospace Science Meeting and Exhibit, 2000.

[26] G. Becker, A. Packard, D. Philbrick, and G. Balas, “Control ofparametrically-dependent linear systems: a single quadratic Lyapunovapproach,” in Proceedings of the American Control Conference, 1993,pp. 2795–2799.

[27] J. L. Wang, G.-H. Yang, and J. Liu, “An LMI approach to H−/H∞

fault detection observer design,” Automatica, vol. 43, pp. 1656–1665,2007.