Documente Academic
Documente Profesional
Documente Cultură
This
chapter
presents
hydrodynamic
models
for
ships,
oshore
structures
and
underwater
vehicles.
The
founda9on
for
the
models
are
the
kinema9c
equa9ons
(Chapter
2),
rigid-body
kine9cs
(Chapter
3),
hydrosta9cs
(Chapter
4),
seakeeping
theory
(Chapter
5)
and
maneuvering
theory
(Chapter
6).
The
models
are
all
expressed
in
a
vectorial
seHng
for
eec9ve
computer
simula9on
and
to
simplify
control
design.
Focus
is
made
towards
preserva9on
of
matrix
proper9es
such
as
symmetry,
skew-symmetry,
posi9ve
deniteness
and
orthogonality
which
are
key
elements
in
nonlinear
control
and
es9ma9on
theory.
1
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
! ! !u, v, r" !
! ! !N, E, !" !
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
J!!" !
R nb!""
0 3!3
0 3!3
T" !""
s!c"
!s"
c"s#
c"c#
1 s!t"
c!t"
T! !!" "
!s!
0 s!/c" c!/c"
R nb !!" !
c!
Copyright Bjarne Stenberg/NTNU
For
small
roll
and
pitch
angles
and
no
heave
this
reduces
to:
cos ! ! sin ! 0
J!!"
3 DOF
R!!! !
sin !
0
cos ! 0
0
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
M RB !
MA ! !
mz g
!my g
!mz g
mx g
my g
!mx g
!mz g
my g
Ix
!I xy
!I xz
mz g
!mx g
!I yx
Iy
!I yz
!my g
mx g
!I zx
!I zy
X u"
X v"
X
X w"
X p"
X q"
X r"
X
Yu"
X
Y v"
Y w"
Y p"
Y q"
Yr"
Zu"
Z v"
Z w"
Z p"
Z q"
Zr"
K u" Kv"
Kw"
Kp"
Kq" K r"
Iz
Nw"
Np"
Nq" N r"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
M RB !
mx g
mx g
Iz
C RB !!" !
mu
!Xu"
MA !
C A !!" !
!Y v" !Y r"
!Y r" !N r"
Y v" v # Y r" r
!X u" u
m ! Xu"
m ! Y v"
mx g !Y r"
mx g !Y r"
I z !N r"
M!
cos ! ! sin ! 0
3 DOF
J!!" ! R!!" !
M RB !
mx g
0 mx g
!X u"
MA !
C RB !!" !
mu
Iz
!Yv" !Yr"
!Yr" !N r"
sin ! cos ! 0
C A !!" !
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Yv" v # Yr" r
!X u" u
Low-speed
maneuvering
Maneuvering
at
high
Maneuvering
at
moderate
speed
(transit)
speed
(high-speed
cra^)
Sta9onkeeping
Speed
0
6
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
.
U = 0.3 Lg
..
8
linear damping: 0.5u*exp(-0.5u*u)
quadratic damping: 0.05|u|u
linear + quadratic damping
-2
Dynamic positioning
|u| < 2 m/s
-4
-6
-8
-8
-6
-4
-2
0
u (m/s)
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
C A !! r " !
Yv" v r # Yr" r
X u" u r
d!! r " !
!Yv !Yr
!N r !N r
1
2
1
!S!1
2
L pp /2
! " !L
1
2
pp
Linear
damping
ITTC
surge
resistance
+
cross-ow
drag
# k"C new
f !u r "|u r |u r
2D
T!x"C
d !x"|v r # xr|!v r # xr"dx
/2
L pp /2
! "!L
pp
2D
T!x"C
d !x"x|v r # xr|!v r # xr"dx
/2
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!X |u|u |u r |u r
"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Copyright Bjarne Stenberg/NTNU
C A !!r " !
X u
Yv" v r # Yr" r
u" r
!X |u|u |u r |
Recall
that
D(r)
=
D
+
Dn(r).
No9ce
that
linear
poten9al
damping
and
skin
fric9on
are
neglected
in
this
model
(D=0)
since
the
nonlinear
quadra9c
terms
Dn(r)
dominate
at
higher
speeds
10
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
x ! !U,
0,
0, 0, 0, 0, 0"
#X!x"
#x i
# 2 X!x"
#x i ! 1
2 !#x i " 2
x0
#Y!x"
#x i
# 2 Y!x"
1
#x i !
2 !#x i " 2
x0
#N!x"
#x i
# 2 N!x"
1
#x i !
2 !#x i " 2
x0
# 3 X!x"
#x 2i ! 1
6 !#x i " 3
x0
#x 2i
x0
# 3 Y!x"
1
!
6 !#x i " 3
#x 2i
x0
# 3 N!x"
1
!
6 !#x i " 3
#x 3i
x0
#x 3i
x0
#x 3i
x0
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Y ! Y ! " Y u $u " Y uu $u 2 " Y r r " Y v v " Y r# r# " Y v# v# " Y ! ! " Y rrr r 3 " Y vvv v 3
F xi !
" Y !!! ! 3 " Y rr! r 2 ! " Y !!r ! 2 r " Y rrv r 2 v " Y vvr v 2 r " Y !!v ! 2 v " Y vv! v 2 ! " Y !vr !vr
" Y vu v$u " Y vuu v$u 2 " Y ru r$u " Y ruu r$u 2 " Y !u !$u " Y !uu !$u 2
N !
N!
" N u $u " N uu
$u 2
r3
" N vvv
F xi xj !
v3
!F!x"
!x i
2
1 ! F!x"
2 !x i !x j
" N !!! ! 3 " N rr! r 2 ! " N !!r ! 2 r " N rrv r 2 v " N vvr v 2 r " N !!v ! 2 v " N vv! v 2 !
" N !vr !vr " N vu v$u " N vuu v$u 2 " N ru r$u " N ruu r$u 2 " N !u !$u
" N !uu !$u 2
12
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
F xi xj xk !
x0
x0
3
1 ! F!x"
6 !x i !x j !x k
x0
v 3 + Yvvr
v2 r
Y = Yv v + Yr r + Yvvv
v r 2 + Yrrr
r 3
+ Yvrr
v
N = N v v + N r r + N vvv
v r
+ N vvr
v r 2 + N rrr
r 3
+ N vrr
2nd-order
Modulus
Curves
Y = Yv v + Yr r + Yv v v v + Yv r v r
+ Y v r v r + Yr r r r
N = N v v + N r r + N v v v v + N v r v r
+ N v r v r + N r r r r
13
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
gives
a
smooth
surface
(physical)
SECOND ORDER
MODULUS
FIT
gives
a
aher
facehed
surface
(nonphysical)
We
obtain
dierent
deriva9ve
values
from
cubic
and
2nd-order
modulus
curve
t.
SECOND ORDER
MODULUS FIT
This
is
a
big
problem
when
comparing
deriva9ves
from
dierent
experimental
facili9es
Yv (TAYLOR )
ODD FUNCTION
TAYLOR
SERIES FIT
Yv (MOD)
v
14
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
U!
u 2 " v2 ! u #
Starboard-port
symmetry
implies
that
surge
is
decoupled
from
sway
and
yaw:
!m ! X u! "u! ! X u u r ! X |u|u |u r |u r " ! 1 #
where
t
is
the
sum
of
control
forces
in
surge.
!r ! !vr, r" !
u ! u o ! constant #
is
the
rudder
angle
is
based
on
the
assump9ons
that
the
cruise
speed.
The
current
forces
are
treated
as
a
linear
term:
N!u o "#v c , 0$ !
15
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
The
poten9al
theory
representa9on
is
obtained
by
extrac9ng
the
2nd
and
3rd
rows
in
CRB()
and
CA()
with
u
=
uo,
resul9ng
in:
C!!"! !
!m " X u! "u o r
D!
!Yv !Yr
!N v !N r
!Y !
! ! b! !
!N !
! #
Resul9ng model
M!
! ! !v, r" !
! ! !! R
16
N!u o " !
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
m ! Y v"
mx g !Y r"
mx g !Y r"
I z !N r"
b!
!Y !
!N !
!Y v
!m ! X u" "u o !Y r
Y!
!"
N!
b
Yv# Yr#
Yv Yr
"# "
N v# N r#
"r #
Nv Nr
MA
Resul9ng model
M !
m ! Y v"
mx g ! Y r"
mx g ! Nv"
I z ! Nr"
!Y v
b!
mu 0 ! Y r
!Nv mx g u 0 ! Nr
NB! This representa9on miss the CA-terms (see red circles on previous slide)
17
!Y!
!N !
v
!
!s" !
K v !1"T v s"
!1"T 1s"!1"T 2s"
T ! T1 " T2 ! T3
!! " r
18
!
K
!s" !
"
s!1 " Ts"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
# The
celebrated
autopilot
model
19
Gain [dB]
100
Phase [deg]
7.7
16622
8.1
118.0
7.8
18.5
46.0
1st-order
2nd-order
0
-100
10
-3
10
-2
10
-1
10
10
-150
-200
-4
-3
10
10
course unstable ship
100
Gain [dB]
0.185
-100
-4
10
-50
10
-2
10
-1
10
Oil tanker
10
0
-100
-200
-4
10
-150
Phase [deg]
10
-3
10
-2
10
-1
10
10
-200
-250
-300
-4
10
10
-3
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
10
-2
Frequency [rad/s]
10
-1
10
10
where
HB(r)
can
be
found
from
Bech's
reverse
spiral
maneuver.
The
linear
equivalent
is
obtained
for
HB(r)
=
r
20
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
The
maneuvering
characteris9cs
are
found
by
solving
for
r
as
a
func9on
of
,
using
the
steady-state
solu9ons
of
the
nonlinear
Nomoto
models:
2
linear (K>0)
nonlinear
r (deg/s)
1
0
(deg)
-2
-20
-15
-10
-5
10
15
20
r (deg/s)
1
H N!r" ! K! #
H B!r" ! !
-2
-20
21
Bech spiral
-15
-10
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
-5
10
15
20
The
pivot
point
for
a
turning
ship
can
be
computed
by
measuring
the
velocity
vg/n(t)
in
CG
and
the
turning
rate
r(t):
x p !t" ! !
v g/n !t"
,
r!t"
r!t" " 0 #
This
expression
is
not
dened
for
a
zero
yaw
rate
corresponding
to
a
straight-line
mo9on.
This
means
that
the
pivot
point
is
located
at
innity
when
moving
on
straight
line
or
in
a
pure
sway
mo9on.
It
is
well
known
to
the
pilots
that
the
pivot
point
of
a
turning
ship
is
located
at
about
1/51/4
ship
length
a^
of
bow
X
22
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
x p!s,s" ! !
v
!
Y!r
" !1160 !
!
m!
10 !5
" !499 !
10 !5
N !v
N !r
x p !t" ! !
v g/n !t"
,
r!t"
r!t" " 0 #
Y!v
K v !1"T v s"
!1"T 1s"!1"T 2s"
!s" !
" !264 !
10 !5
" !166 !
10 !5
N !! " !139 ! 10 !5
xp!s,s" ! 0.4923L pp #
Loa
Lpp
xp=0.4923Lpp
0.023Lpp
AP
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
CG
CO
0.5Lpp
0.03Lpp
Pivot
point
FP
Bow
U!
u2 " v 2
The
most
commonly
used
normaliza9on
forms
for
marine
cra^
are:
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Unit
Nota9on:
x
x
x
Prime-system I Prime-system II Bis-system
Length
Mass
Inertia moment
m
<
1
:
ROVs,
AUVs,
submarines,
etc.
m
=
1
:
Floa9ng
ships/rigs
and
neutrally
buoyant
underwater
vehicles,
that
is:
m ! !!
Time
Reference area
Position
Angle
Linear velocity
Angular velocity
Linear acceleration
Angular acceleration
Force
Moment
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
1
2
1
2
!L 3
!L 5
L
1
2
1
2
!L 2 T
"!!
!L 4 T
"!!L2
L
U
L
U
L2
LT
L/g
"
2!
L
Lg
U
L
U
L
g/L
U2
L
U2
L2
1
!U 2 L2
2
1
!U 2 L3
2
U2
L
U2
L2
1
!U 2 LT
2
1
!U 2 L2 T
2
g
g
L
"!g!
"!g!L
Y ! Yr r
?
N=kgm/s
rad/s
Hence,
the
unknown
dimension
must
be
kgm/s
since
rad
is
a
nondimensional
unit.
The
nondimensional
values
Yr
and
Yr
are
found
by
using
kg,
m
and
s
in
the
Conversion
Table.
Consequently:
Prime
Bis
Y!r "
Yr
1
! !L3"!L"
2
!L/U"
Y!!r "
Yr
!!"!"!L"
L/g
26
"
"
1
1
!L 3U
2
1
!"! Lg
Yr
Yr
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
! ! 1 and m ! "!
oa9ng
ship
Y!!r "
1
m Lg
Yr
M "
N ! !u !0 " "
m ! ! Y!v#
m ! x !g ! Y !r#
m ! x !g ! N !v#
I !z ! N!r#
!Y
!
v
b "
!Y!!
!N !!
m ! u !0 ! Y!r
!N !v m ! x !g u !0 ! N!r
where
u!0 "
u0
U
! 1, for #u ! 0 and #v ! 0
The
nondimensional
veloci9es
and
control
input
can
be
transformed
to
its
dimensional
values
by
using
the
Conversion
Table:
v ! Uv " ,
27
r!
U
L
r" ,
! ! !"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
T!diag!1, 1, 1, L1 , 1L , L1 ",
Generalized accelera9on, velocity, posi9on and force are then found from:
Prime-system
28
U2
L
T!" "
Bis-system
!" ! g T!" ""
acceleration
!" !
velocity
! ! U T! "
! !
position/attitude
# $L T# "
# $LT# ""
control forces/moments
%!
1
2
!U 2 L2 T!1 % "
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Lg T! ""
M!
L
U2
1
U
!" !
6-DOF
normaliza9on
procedure
1
2
29
!!
1
1
!U 2L 2
2
1
2
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
1
2
T$
!!
!!
!TM! T!1"!" " ! UL " !TD! T!1 "! " ! UL " !TG ! T!1"# #
1
1
!L 3
2
T2$
g
L
g
L
1
!""
T2 $
dimensional
states/inputs
nondimensional
parameters
Resul9ng model:
30
g
L
T"2 !TD !! T"1 " ! " !"! L T"2 !TG !! T"1 " # # $
D
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
! ! " !v ! , r ! " !
T ! diag!1, 1/L"
!TM ! T!1 "!" #
U
L
U2
L
! ! !"
Tb ! !
Component form:
m !11
1
L
m !21
Lm !12
v"
m !22
r"
U
L
n !11
1
L
n !21
Ln !12
n !22
v
r
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
U2
L
b!1
1
L
b!2
K! " !L/U" K,
!
T ! " !U/L" T
!
2 K#
T#
This
representa9on
is
quite
useful
since
the
nondimensional
gain
and
9me
constants
will
typically
be
in
the
range:
0.5
<
K
<
2
and
0.5
<
T
<
2
for
most
ships.
An
extension
to
Nomoto's
2nd-order
model
is
obtained
by
wri9ng:
!L/U" 2 T !1 T !2 ! !3" " !L/U" !T !1 " T !2 " !# " !$ % !U/L" K! " " K ! T!3 "$
where
the
nondimensional
9me
and
gain
constants
are
dened
as:
Ti
=
Ti
(U/L)
(i=1,2,3)
K
=
(L/U)K
32
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Zero-speed representa9on
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
! rc ! !atan2!v rc , u rc "
34
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
This
gives
the
following
analy9cal
expressions
for
the
area
based
current
coecients
similar
to
Fal9nsen
(1990),
pp.
187-188.
!X |u|u
C X !! c " ! !2
cos!! c "|cos!! c "|
#
"AFc
!Y|v|v |
C Y !! c " ! 2
sin!! c "|sin!! c "|
#
"ALc
2
C N !! c " !
!!N |v|v sin!! c "|sin!! c "|" 1 !X u# ! Yv# "
sin!2! c "" #
2
"ALc L oa
A !A
22
35
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
11
0.6
0.4
0.2
CX
-0.2
CX = -C X,max*cos(g)*abs(cos(g))
CY
CY = CY,max*sin(g)*abs(sin(g))
-0.4
CN
CN = CN,max*sin(2*g)
-0.6
20
40
60
80
100
120
140
Angle of attackgc relative bow - counter-clockwise rotation (deg)
160
180
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
M#" " C RB !#"# " D exp!!"V rc "#r " d!V rc , # rc " ! $ " $ wind " $waves #
D!
!X u
!Y v
!Y r
!N v
!N r
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!
!" p ! R" !!"! " R! !!"!" ! R! !!"!"
!" ! R!!"#
38
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Note
that:
The
kinema9cs
is
linear
GPS-posi9on
measurements
h
must
be
transformed
to
vessel-parallel
coordinates
using
! p ! R ! !!"! #
!! " p
m ! Y v"
M!
!mz g ! Kv"
I x ! K p"
!I xz ! N p"
mx g ! Nv"
!I xz ! Np"
I z ! N r"
! ! !v, p, r" !
! ! !E,!, "" !
!Y v !Yp
N!u o ! !
mu 0 ! Yr
!Kv !K p !mz g u 0 ! K r
!Nv !N p
mx g u 0 ! N r
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
40
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
x! !
a 11 a 12 a 13 a 14 0
b 11 b 12 ! b 1r
a 21 a 22 a 23 a 24 0
b 21 b 22 ! b 2r
x"
a 31 a 32 a 33 a 34 0
b 31 b 32 ! b 3r
x ! !v, p, r, !, "" !
u
! ! !0, 0, 0, 1, 0"x #
A
where
the
matrix
elements
are:
a 11 a 12 a 13
a 21 a 22 a 23
!1
! !M N!u o ! #
! ! TKu
a 31 a 32 a 33
" a 14 "
" a 24 "
! !M !1 G
" a 34 "
41
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
a 11 a 13 0 a 12 a 14
b 11 b 12 ! b 1r
r!
a 31 a 33 0 a 32 a 34
b 31 b 32 ! b 3r
!!
"
p!
"!
a 21 a 23 0 a 22 a 24
x! !
A !! A!"
x!
A "! A""
x"
x! "
"
"
B!
B"
b 21 b 22 ! b 2r
x! ! !v, r, !" !
x! ! !p, !" !
"
!!
p!
!!
42
a 11 a 13 0
a 31 a 33 0
"
a 22 a 24
1
b 11 b 12 ! b 1r
b 31 b 32 ! b 3r
p
!
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
b 21 b 22 ! b 2r
0
!s" !
!
!s"
"
b 2s 2"b 1s"b 0
s 4"a 3s 3"a 2s 2"a 1s"a 0
c 3s 3"c 2s 2"c 1s"c 0
s!s 4"a 3s 3"a 2s 2"a 1s"a 0"
!
!
K yaw !1"T3s"
s!1"T1s"!1"T2s"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
non-minimum
phase
property
"
!
0. 0024!s " 0. 0436"!s 2 "0. 162s " 0. 035"
!s" !
"
s!s " 0. 0261"!s " 0. 116"!s 2 "0. 136s " 0. 036"
!
44
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!m ! m x "u" ! !m ! m y "vr # X ! ! x
!m ! m y "v" ! !m ! m x "ur ! m y " y r" ! m y l y p" # Y ! ! y
3rd-order
# Taylor-series
expansion
#
N ! N v v " Nr r " N! ! " Np p " Nvvv v 3 " N rrr r 3 " N vvr v 2 r " Nvrr vr 2
" N vv! v 2 ! " Nv!! v! 2 " Nrr! r 2 ! " N r!! r! 2 " N " cos " " Next
45
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
"
46
m ! Y v!
!mz g !Y p!
mx g !Y r!
v!
!mz g !K v!
I x !K p!
p!
mx g !N v!
I z !N r!
r!
!!
"!
2nd-order
modulus
model
Y uv |u|
Y |u|p |u|
!mu " Y ur u
Y uu! u 2
Y ext
K |u|v |u|
K up u " K p
K ur u
K ext
N uv u
N |u|r |u|!mx g u
N |u|u! |u|u
"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
N ext
"! #
u v " Y v
" Y
L
3
vvv
#
#X LD
L r3
rrr
" YLrrv r 2 v " YLvvr v 2 r " YLuv!! uv! 2 " YLur!! ur! 2
#
#Y LD
K LD ! YLD z cp
! K Luv uv " K Lur ur " K Luur u 2 r " K Luuv u 2 v " K Lvvv v 3
" K Lrrr r 3 " K Lrrv r 2 v " K Lvvr v 2 r " K Luv!! uv! 2 " K Lur!! ur! 2
N LD ! YLD x cp
! N Luv uv " N Lur ur " N Luur u 2 r " N Luuv u 2 v " N Lvvv v 3
" N Lrrr r 3 " N Lrrv r 2 v " N Lvvr v 2 r " N Luv!! uv! 2 " N Lur!! ur! 2
47
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
D!!" !
L
L
!Y uv!! v! 2 !Y ur!! r! 2
L
L
!K uv!! v! 2 !K ur!! r! 2
L
L
!N uv!! v! 2 !N ur!! r! 2
48
L
!X L
vv v ! X rv r
L
2
!X L
uvv uv ! X vv!! v!
L
!X vr!! r! 2
L
2 L
2
!Y L
uv u ! Y uuv u !Y vvv v
2
!Y L
rrv r !Y |v |v |v|!Y |r|v |r|
L
2 L
2
!K L
uv u ! K uuv u !K vvv v
2
!K L
rrv r !K |v |v |v|!K |r|v |r|
L
2 L
2
!N L
uv u ! N uuv u !N vvv v
2
!N L
rrv r !N |v |v |v|!N |r|v |r|
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
L
L
2
!X L
rr r ! X urr ur ! X rr!! r!
L 2 L 2
!Y L
ur u ! Y uur u !Y rrr r
!K p !K ppp
2
!Y L
vvr v !Y |v |r |v|!Y |r|r |r|
p2
L 2 L 2
!K L
ur u ! K uur u !K rrr r
2
!K L
vvr v !K |v |r |v|!K |r|r |r|
L 2 L 2
!N L
ur u ! N uur u !N rrr r
2
!N L
vvr v !N |v |r |v|!N |r|r |r|
M!
C A !!" !
49
m ! X u"
m ! Y v"
!mz g !Y p"
mx g !Y r"
!mz g !K v"
I x !K p"
mx g !N v"
I z !N r"
Y v" v
!X u" u
Y v" v
!Y v" v
X u" u
!Y v" v
,G !
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
, C RB !!" !
!K !
mz g r
!m!x g r # v"
mu
!mz g r
m!x g r # v"
!mu
50
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Copyright Bjarne Stenberg/NTNU
M ! MRB " MA
M!! " C!!"! " D!!"! " g!"" " g o # # " #wind " #wave #C!!" ! C RB !!" " C A !!" #
51
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
# " " J !1
!
# !!"!
R nb !! nb "
0 3!3
0 3!3
T" !! nb "
"1
"1
#
C ! !", !" ! J "!
" !!"#C!"" " MJ " !!"J " !!"$J " !!"
"1
D ! !", !" ! J "!
" !!"D!""J " !!"
M! !!"!! " C ! !", !"!# " D ! !", !"!# " g ! !!" " g !o $ #! " #!wind " #!waves #
52
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!1
T!q !q" ! !T"q !q"Tq !q"" T"q !q"
! 4T"q !q"
M! !!"!! " C ! !", !"!# " D ! !", !"!# " g ! !!" " g !o $ #! " #!wind " #!waves #
53
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
M!
54
C!!" ! !C ! !!",
"! # " 6
m ! X u"
!X v"
!X w"
!X p"
mz g !X q"
!my g !X r"
!X v"
m ! Y v"
!Y w"
!mz g !Y p"
!Y q"
mx g !Y r"
!X w"
!Y w"
m ! Z w"
my g !Z p"
!mx g !Z q"
!Z r"
!X p"
!mz g !Y p"
my g !Z p"
I x !K p"
!I xy !K q"
!I zx !K r"
mz g !X q"
!Y q"
!mx g !Z q"
!I xy !K q"
I y !M q"
!I yz !M r"
!my g !X r"
mx g !Y r"
!Z r"
!I zx !K r"
!I yz !M r"
I z !N r"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
M! !!"!! " C ! !", !"!# " D ! !", !"!# " g ! !!" " g !o $ #! " #!wind " #!waves #
.
> 0 and
M
=
0.
since
M =
It
should
be
noted
that
C(,)
will
not
be
skew-symmetrical
although
C() is
skew-
symmetrical.
MT
55
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
M ! M! " 0
! !0
M
K p ! K !p " 0
!" ! J k !!"#
K d ! 0 Nonlinear PD-controller
"0
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
m 11 m 12
m 16
m 11
m 13
m 15
m 21 m 22
m 26
m 22
m 24
m 26
m 31
m 33
m 35
m 33 m 34 m 35
m 43 m 44 m 45
m 42
m 44
m 46
m 53 m 54 m 55
m 51
m 53
m 55
m 66
m 62
m 64
m 66
m 61 m 62
M!
M!
m 15 m 16
m 22 m 23 m 24
m 32 m 33 m 34
m 42 m 43 m 44
M!
m 11
m 15
m 22
m 24
m 33
m 42
m 44
m 51
m 55 m 56
m 51
m 55
m 61
m 65 m 66
m 66
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
P!!! !
58
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
R!!! 0 3"3
03"3
I3"3
xb
!p
BODY
NED
xn
yb
yn
59
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
! rS! p #$
where
r
!
!
"
and
0
1 0 0 0 0
!1 0 0 0 0 0
S!
0 0 0 0 0
0 0 0 0 0
0 0 0 0 0
!"p ! #
60
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Copyright
Bjarne Stenberg/NTNU
The
gravita9onal
and
buoyancy
forces
can
also
be
expressed
in
terms
of
VP
coordinates.
For
small
roll
and
pitch
angles:
!!"!0
g!!" ! P ! !#"G! "P ! !#"GP!#" ! p ! G! p
G
No9ce
that
this
formula
conrms
that
the
restoring
forces
of
a
leveled
vessel = = 0 is
independent
of
the
yaw
angle
.
P! !!"GP!!" ! G
0 2!2
G!
0 3!2
0
61
0 2!3
0
0
, Gr !
0
0
!Z z
!Z "
!K #
!M z
!M "
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
! g!#"
! g o " $ ! $wind ! $waves #
%
w
D!
G#p
!" p ! #
x! " Ax # Bu # Ew
M#" $ D# $ G! p ! % $ w #
! " P!!!!p
A!
!M !1G !M !1D
B!
0
M !1
E!
0
M !1
which
is
the
linear
^me
invariant
(LTI)
state-space
model
used
in
DP.
62
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!! " ! ! ! o
!" p ! "# # # o #
A!u o " !
63
!M !1 G !M !1 N!u o !
, B !
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
0
M !1
, E!
0
M !1
F!
I
0
rg
CG
CO
P
64
rp
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
v bb/n
! H!rbp "
! bb/n
! bb/n
CO
"
" p ! H!rbp ""
H!rbp " !
f bb
mbb
0 3!3
I3!3
f bp
rbp ! f bp " mbp
H !1 !rbp " !
rp
rg
CG
I3!3
0 3!3
f bp
mbp
I3!3
#
! ! H ! !rbp "! p
65
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Mp
"H
!!
C p !!"
!p " H
D p !!"
!!
!rbp "g!""
#H
!!
!rbp "#
g p !""
#p
66
!p
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!X w"
mz g !X q"
m ! Y v"
!mz g !Y p"
mx g !Y r"
!X w"
m ! Z w"
!mx g !Z q"
!mz g !Y p"
I x !K p"
!I zx !K r"
mz g !X q"
!mx g !Z q"
I y !M q"
mx g !Y r"
!I zx !K r"
I z !N r"
!! " J!!"" #
M!! " C!!"! " D!!"! " g!"" # # #
M!
D n !!"! !
|!|! D
n4 !
|!|! D
n5 !
|!|! D
n6 !
d!V rc ,! cr " !
67
! diag#X |u|u |u|, Y|vv| |v|, Z |w|w |w|, K |p|p |p|, M |q|q |q|, N |r|r |r|$
|!|! D n2 !
|!|! D n3 !
D!!" ! !diag#X u , Yv , Z w , K p , M q , N r $
|!|! D n1 !
1
2
1
2
1
2
1
"AL c H L c C K !! rc "V 2rc
2
1
"AF c H F c C M !! rc "V 2rc
2
1
"AL c L oa C N !! rc "V 2rc
2
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
1
2
1
2
3DOF
0
0
1
2
68
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
m 11 m 12
m 16
m 11
m 13
m 15
m 21 m 22
m 26
m 22
m 24
m 26
m 31
m 33
m 35
m 33 m 34 m 35
m 43 m 44 m 45
m 42
m 44
m 46
m 53 m 54 m 55
m 51
m 53
m 55
m 66
m 62
m 64
m 66
m 61 m 62
xy-plane
of
symmetry
(boeom/top
symmetry):
M!
69
m11
0
0
m 15
m 22
m 24
m 33
m 42
m 44
m 51
m 55
m 66
yz-plane
of
symmetry
(fore/a^
symmetry)
M!
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
xz-plane
of
symmetry
(port/starboard
symmetry)
M ! diag!m 11 , m 22 , m 33 , m 44 , m 55 , m 66 "
xz-,
yz-
and
xy-planes
of
symmetry
(port/
starboard,
fore/a^
and
bohom/top
symmetries).
m 11 m 13 m 15
M long !
m 31 m 33 m 35
m 22 m 24 m 26
, M lat !
m 51 m 53 m 55
70
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
m 42 m 44 m 46
m 62 m 64 m 66
J!!" !
n
R b !!" !
T! !!" "
R nb!""
0 3!3
0 3!3
T" !""
v, p, r, ! are small
s!c"
!s"
c"s#
c"c#
1 s!t"
c!t"
!s!
c!
0 s!/c" c!/c"
"
cos ! 0
0
w
q
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
! sin!
0
For
simplicity,
it
is
assumed
that
higher
order
damping
can
be
neglected-that
is,
D
n
!!"
!
0
.
Coriolis
is,
however,
modeled
by
assuming
that
u
!
0
and
that
2nd-order
terms
in
v,w,p,q
and
r
are
small.
Hence,
DOFs
1,
3,
5
gives:
m!y g q " z g r"p ! m!x g q ! w"q ! m!x g r " v"r
!m!z g p ! v"p ! m!z g q " u"q " m!x g p " y g q"r
C RB !!"! !
m!x g q ! w"u ! m!z g r " x g p"v " m!z g q " u"w "!I yz q " Ixz p ! Iz r"p " !!Ixz r ! Ixy q " I x p"r
Collec9ng
terms
in
u,w,
and
q,
gives:
The
skew-symmetric
property
is
0 0
0
u
destroyed
for
the
decoupled
model:
C !!"! !
0 0 "mu
w
RB
C RB !!" ! "C !RB !!"
0 0 mx g u
q
Assuming
a
diagonal
MA
gives:
!Z w" wq # Y v" vr
C A !!"! !
!Y v" vp # X u" uq
!Zw" !X u" "uw # !N r" !K p" "pr
72
"
X u" u
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
0
g!!! !
0
W BG z sin !
73
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!X w!
mz g ! X q!
u!
!X w!
m ! Zw!
!mx g ! Z q!
w!
I y ! M q!
q!
mz g ! X q! !mx g ! Z q!
"
!!m ! X u! "u
0 !Zw! ! X u! "u
"
mx g u
!X u
!X w
!X q
!Zu
!Zw
!Zq
!M u !M w !M q
"1
0
"
W BG sin !
!Z w
!Z q
!Mw !Mq
"3
"5
u ! u o ! constant
"
74
m ! Z w!
!mx g !Z q!
w!
!mx g !Z q!
Iy !M q!
q!
"
!Z w! !Xu! "u o
mx g u o
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
"
0
BG z W sin !
"3
"5
!I y ! Mq! "!" ! M q!! # BG zW!
where
the
natural
frequency
and
period
are:
! pitch !
75
W BG z
,
I y ! M q"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
$ "5
T pitch ! !2"
pitch
J!!" !
n
R b !!" !
T! !!" "
R nb!""
0 3!3
0 3!3
T" !""
s!c"
!s"
c"s#
c"c#
1 s!t"
c!t"
!s!
c!
0 s!/c" c!/c"
!! " p #
"! " r #
76
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
Zw" wp ! Xu" ur
C A !!"! !
77
0 !X u" u
"
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
0
g!!" "
W BG z sin !
0
78
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!mz g ! Y p! mx g ! Yr!
!mz g ! Yp!
I x ! K p!
!I zx ! K r!
p!
mx g ! Yr!
!I zx ! Kr!
I z ! N r!
r!
"
0 !m ! X u! "u
!X u! ! Yv! "u 0
!Yv
"
!Yp
!M v !M p !M r
!N v !N p !N r
"2
0
"
mx g u
!Yr
v!
W BG z sin !
"4
"6
u ! u o ! constant
m ! Y v!
mx g !Y r!
v!
mx g !Y r!
Iz !N r!
r!
"
79
"
!Yv !Yr
!N v !N r
!m ! Xu! "u o
!X u! !Y v! "u o
mx g u o
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)
!2
!6
"
!
!I
x ! Kp! "! ! Kp! # WBG z!
where
the
natural
frequency
and
period
are:
! roll !
80
W BG z
,
I x ! K p"
$ "4
T roll ! !2"
roll
Lecture Notes TTK 4190 Guidance and Control of Vehicles (T. I. Fossen)