Diagnosis and FTC by Prof. Blanke [pdf] - NTNU

Diagnosis and FTC by Prof. Blanke [pdf] - NTNU Diagnosis and FTC by Prof. Blanke [pdf] - NTNU

12.04.2013 Views

39 40 Model of normal behavior of ship 3 ( ) c1: ω3 = b h1ω3+ h3ω3 + bδ c2: ψ= ω3+ ω3w c3 : ψm= ψ c4: ω3m ω3+ ω3w c5 : d1 : δm= ψ = δ dψ dt δ d2 ω3 = dω3 dt rudder angle b + + ∫ ω3 δ steering characteristic wave disturbance Linearized model with sensor faults δ rudder angle ω3 = b( δ + h1ω3) ψ= ω3+ ω3w ψm= ψ + fψ linearized at ω3=0 ω3m = ω3+ ω3w + fω δ = δ m b + + ∫ ω3 δ steering characteristic ω3 ω3 wave disturbance + + f ω ωw + ωw + + + ω3m rate measurement ∫ f ψ ψ ψm heading measurement Mogens Blanke – Spring 2006 ∫ + fω + ω3m fψ rate measurement + Mogens Blanke – Spring 2006 + ψ + ψm heading measurement + 20

41 42 Example on requirements to diagnosis • Requirements for motion control • f rate (t) t det < 1deg • f angle (t) t det < 5 deg*s • Obtained in theory and practice • Accommodation of sensor faults on the fly is possible Analysis based on structure Mogens Blanke – Spring 2006 Mogens Blanke – Spring 2006 21

39<br />

40<br />

Model of normal behavior of ship<br />

3 ( )<br />

c1: ω3 = b h1ω3+ h3ω3 + bδ<br />

c2:<br />

ψ= ω3+ ω3w<br />

c3<br />

: ψm= ψ<br />

c4:<br />

ω3m ω3+ ω3w<br />

c5<br />

:<br />

d1<br />

:<br />

δm= ψ<br />

=<br />

δ<br />

dψ<br />

dt<br />

δ<br />

d2<br />

ω3<br />

=<br />

dω3<br />

dt<br />

rudder<br />

angle<br />

b<br />

+<br />

+<br />

∫<br />

ω3<br />

δ<br />

steering<br />

characteristic<br />

wave<br />

disturbance<br />

Linearized model with sensor faults<br />

δ<br />

rudder<br />

angle<br />

ω3 = b( δ + h1ω3)<br />

ψ= ω3+ ω3w<br />

ψm= ψ + fψ<br />

linearized at ω3=0<br />

ω3m = ω3+ ω3w<br />

+ fω<br />

δ = δ<br />

m<br />

b<br />

+<br />

+<br />

∫<br />

ω3<br />

δ<br />

steering<br />

characteristic<br />

ω3<br />

ω3<br />

wave<br />

disturbance<br />

+<br />

+<br />

f ω<br />

ωw<br />

+<br />

ωw<br />

+<br />

+<br />

+<br />

ω3m<br />

rate<br />

measurement<br />

∫<br />

f ψ<br />

ψ<br />

ψm<br />

heading<br />

measurement<br />

Mogens <strong>Blanke</strong> – Spring 2006<br />

∫<br />

+<br />

fω +<br />

ω3m<br />

fψ rate<br />

measurement<br />

+<br />

Mogens <strong>Blanke</strong> – Spring 2006<br />

+<br />

ψ<br />

+<br />

ψm<br />

heading<br />

measurement<br />

+<br />

20

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!