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

71 72 Case: ship station-keeping control • Position control is required within a specified circle to enable investigation of an unknown object • Ship has two shafts and a bow thruster for control Constraints – forces from actuators ( ) ( ) ( ) a1: θ1 = gpu1 pitch and shaft speed on starboard shaft a2 : θ2 = gpu2 pitch and shaft speed on port shaft a3 : n3 = gbu3 angular velocity on bow thruster b1: y1 = θ1 measurement of SB pitch and rpm b2 : y2 = θ2 measurement of port pitch and rpm b : y = n measurement of BT rpm 3 3 3 Mogens Blanke – Spring 2006 Mogens Blanke – Spring 2006 36

73 74 Constraints – forces from actuators c N =− l c ( θ ) + l c ( θ ) + l c ( n ) torque from actuators and wind c : T c ( n ) g ( ) total sway force c : T c ( ) c ( ) g ( ) total surge force 1 : z y T 1 y T N + gw ( vw) 2 x b 3 2 y = b 3 + Y w vw 3 x = T θ1 + T θ2 + X w vw Constraints – dynamics and kinematics c4: −1⎡Tx⎤ −1 v= M ⎢ ⎥−A ( ψ ) vc ⎣Ty⎦ linear acc. of body c5 : p= A( ψ ) v+ vc geographical position c6: −1 ψ = I N angular acc. of body d1 : d v= v dt differential d2 : d p= p dt differential d3 : d d ψ = ( ψ) dt dt double differention Mogens Blanke – Spring 2006 Mogens Blanke – Spring 2006 37

71<br />

72<br />

Case: ship station-keeping control<br />

• Position control is required within a specified circle to<br />

enable investigation of an unknown object<br />

• Ship has two shafts <strong>and</strong> a<br />

bow thruster for control<br />

Constraints – forces from actuators<br />

( )<br />

( )<br />

( )<br />

a1: θ1<br />

= gpu1 pitch <strong>and</strong> shaft speed on starboard shaft<br />

a2 : θ2<br />

= gpu2 pitch <strong>and</strong> shaft speed on port shaft<br />

a3 : n3 = gbu3 angular velocity on bow thruster<br />

b1:<br />

y1 = θ1<br />

measurement of SB pitch <strong>and</strong> rpm<br />

b2<br />

: y2 = θ2<br />

measurement of port pitch <strong>and</strong> rpm<br />

b : y = n<br />

measurement of BT rpm<br />

3 3 3<br />

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

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

36

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

Saved successfully!

Ooh no, something went wrong!