12.04.2013 Views

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

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

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

SHOW MORE
SHOW LESS

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

75<br />

76<br />

Constraints - measurements<br />

Variables<br />

m1<br />

: vm= v velocity - inertial system<br />

m2 : h1<br />

= ψ heading - gyro 1<br />

m3 : h2<br />

= ψ heading - gyro 2<br />

m4<br />

: p1 = p position - GPS 1<br />

m5<br />

: p2 = p position - GPS 2<br />

m6<br />

: cm = vc<br />

sea current - log&imu<br />

m : w = v wind - anomometer<br />

7<br />

m w<br />

Seperate variables into known K<strong>and</strong> unknown X.<br />

Seperate known vars. further into input <strong>and</strong> measured:<br />

K = Ki ∪ Km<br />

Unknown : X =<br />

⎧θ1, θ2,<br />

n3,<br />

⎫<br />

⎨ ⎬<br />

⎩Nz, Ty, Tx,<br />

ψ , vpv , , c, vw⎭<br />

Input : Ki = { u1, u2, u3}<br />

Measured : Km<br />

=<br />

⎧y1, y2,<br />

y3,<br />

⎫<br />

⎨ ⎬<br />

⎩h1, h2,<br />

vm, p1, p2, cm, wm⎭<br />

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

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

38

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

Saved successfully!

Ooh no, something went wrong!