Professional Documents
Culture Documents
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Chapter 3 - Dynamics of Marine Vessels
3.1 Rigid-Body Dynamics
3.2 Hydrodynamic Forces and Moments
3.3 6 DOF Equations of Motion
3.4 Model Transformations Using Matlab
3.5 Standard Models for Marine Vessels
M~ +CO+O+DO+O+gO^OUpg
o
w
M - system inertia matrix (including added mass)
CO+O- Coriolis-centripetal matrix (including added mass)
DO+O- damping matrix
gO^O - vector of gravitational/buoyancy forces and moments
p - vector of control inputs
g
o
- vector used for pretrimming (ballast control)
w - vector of environmental disturbances (wind, waves and currents)
2
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
A floating or submerged vessel can be pretrimmed by pumping water between the
ballast tanks of the vessel. This implies that the vessel can be trimmed in heave,
pitch and roll:
3.2.4 Ballast Systems
z Uz
d,
-U-
d
, e Ue
d
3 modes with restoring forces/moment
Steady-state solution:
M~ +CO+O+DO+O+gO^OUpg
o
w
X X X X
gO^
d
OUg
o
w
^
d
U>, >, >, z
d
, -
d
, e
d
, >
where
The ballast vector g
o
is computed by using hydrostatic analyses.
main equation for ballast computations
3
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Consider a marine vessel with n ballast tanks of volumes V
i
V
i,max
(i=1,,n).
For each ballast tank the water volume is defined:
3.2.4 Ballast Systems
V
i
Oh
i
OU+
o
h
i
A
i
OhOdh 4A
i
h
i
, (A
i
OhOUconstant)
A(h)
i i
h
i
V
i
W
i
g
x
z
zoom in
Z
ballast
U
iU1
n
W
i
U_g
iU1
n
V
i
The gravitational forces W
i
in heave are:
4
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.2.4 Ballast Systems
Restoring moments due to the heave force Z
ballast
:
r
i
b
Ux
i
, y
i
, z
i
iU1
n
y
i
V
i
M
ballast
U>_g
iU1
n
x
i
V
i
#
#
m Ur f
U
x
y
z
0
0
Z
ballast
U
yZ
ballast
>xZ
ballast
0
#
g
o
U
0
0
Z
ballast
K
ballast
M
ballast
0
U_g
0
0
iU1
n
V
i
iU1
n
y
i
V
i
>
iU1
n
x
i
V
i
0
Resulting
ballast
model:
5
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Conditions for Manual Pretrimming
Trimming is usually done under the assumptions that and are small such:
3.2.4 Ballast Systems
Reduced order system (heave, roll, and pitch):
-
d
e
d
gO^
d
O4G^
d
G
r
U
>Z
z
0 >Z
e
0 >K
-
0
>M
z
0 >M
e
g
o
r
U_g
iU1
n
V
i
iU1
n
y
i
V
i
>
iU1
n
x
i
V
i
^
d
r
Uz
d
, -
d
, e
d
w
r
Uw
3
, w
4
, w
5
G
r
^
d
r
Ug
o
r
w
r
-
>Z
z
0 >Z
e
0 >K
-
0
>M
z
0 >M
e
z
d
-
d
e
d
U
_g
iU1
n
V
i
w
3
_g
iU1
n
y
i
V
i
w
4
>_g
iU1
n
x
i
V
i
w
5
#
Steady-state
condition:
This is a set of linear
equations where
the volumes V
i
can be found by
assuming that w
i
=0
(zero disturbances)
6
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Assume that the disturbances in heave, roll, and pitch have means of zero.
Consequently:
and
can be written:
3.2.4 Ballast Systems
>Z
z
0 >Z
e
0 >K
-
0
>M
z
0 >M
e
z
d
-
d
e
d
U
_g
iU1
n
V
i
w
3
_g
iU1
n
y
i
V
i
w
4
>_g
iU1
n
x
i
V
i
w
5
w
r
Uw
3
, w
4
, w
5
U0
H]Uy
-
_g
1 } 1 1
y
1
} y
n>1
y
n
>x
1
} >x
n>1
>x
n
V
1
V
2
_
V
n
U
>Z
z
z
d
>Z
e
e
d
>K
-
-
d
>M
z
z
d
>M
e
e
d
#
#
]UH
.
y UH
OHH
O
>1
y
The water volumes V
i
is found by using the pseudo-inverse:
7
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Example (Semi-Submersible Ballast Control) Consider a semi-submersible
with 4 ballast tanks located at
In addition, yz-symmetry implies that
3.2.4 Ballast Systems
P P
P
P
P P
V
1
V
2
V
4
V
3
x
b
y
b
O
p
1
p
2
p
3
+
+
+
r
1
b
U>x, >y, r
2
b
Ux, >y, r
3
b
Ux, y,r
4
b
U>x, y
Z
e
UM
z
U0
H U_g
1 1 1 1
>y >y y y
x >x >x x
y U
>Z
z
z
d
>K
-
-
d
>M
e
e
d
U
_gA
wp
O0Oz
d
_g_GM
T
-
d
_g_GM
L
e
d
]U
V
1
V
2
V
3
V
4
U
1
4_g
1 >
1
y
1
x
1 >
1
y
>
1
x
1
1
y
>
1
x
1
1
y
1
x
_gA
wp
O0Oz
d
_g_GM
T
-
d
_g_GM
L
e
d
]UH
.
y UH
OHH
O
>1
y
Inputs:
z
d
, -
d
, e
d
8
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
An example of a highly sophisticated pretrimming system is the
SeaLaunch trim and heel correction system (THCS):
3.2.4 Ballast Systems
SeaLaunch:
This system is designed such
that the platform maintains
constant roll and pitch angles
during changes in weight. The
most critical operation is when
the rocket is transported from
the garage on one side of the
platform to the launch pad.
During this operation the
water pumps operate at their
maximum capacity to
counteract the shift in weight.
A feedback system controls the pumps to maintain the
correct water level in each of the legs during
transportation of the rocket
9
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.2.4 Ballast Systems
Automatic Pretrimming using Feedback from
In the manual pretrimming case it was assumed that w
r
=0. This assumption can
be removed by using feedback.
The closed-loop dynamics of a PID-controlled water pump can be described by a
1st-order model with amplitude saturation:
T
j
(s) is a positive time constant
p
j
(m/s) is the volumetric flow rate pump j
p
d
j
is the pump set-point.
The water pump capacity is different for
positive and negative flow directions:
z
d
, -
d
, e
d
T
j
p~
j
p
j
UsatOp
d
j
O
satOp
d
j
OU
p
j,max
p
j
p
j,max
p
d
j
p
j,max
>
p
d
j
p
j,max
p
j,max
>
p
d
j
p
j,max
>
0.63 O
O CE ,
O
O CE ,
O
4
+
10
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Example (Semi-Submersible Ballast Control, Continues): The water flow
model corresponding to the figure is:
3.2.4 Ballast Systems
P P
P
P
P P
V
1
V
2
V
4
V
3
x
b
y
b
O
p
1
p
2
p
3
+
+
+
V
~
1
U>p
1
V
~
2
U>p
3
V
~
3
Up
2
p
3
V
~
4
Up
1
>p
2
Tp~p UsatOp
d
O
]~ULp
#
#
]U
V
1
V
2
V
3
V
4
, p U
p
1
p
2
p
3
, L U
>1 0 0
0 0 >1
0 1 1
1 >1 0
11
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
-
T
-1
L sat( )
.
p
p
d
g
o
( )
r
-
ballast
controller
G
r
29.775 15
Z
1
l
roll
pitch
3.2.4 Ballast Systems
Roll and pitch angles during lift-off
CNN
10th October 1999
16
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.3 6 DOF Equations of Motion
Body-Fixed Vector Representation
M ~ +CO+O+DO+O+gO^OUpg
o
w
~ ^UJO^O+
#
#
M UM
RB
M
A
CO+OUC
RB
O+OC
A
O+O
DO+OUD
P
O+OD
S
O+OD
W
O+OD
M
O+O
#
#
#
NED Vector Representation
Kinematic transformation (assuming that exists-i.e., ): J
>1
O^O e 4=[/2
~ ^ U JO^O+ q + U J
>1
O^O~ ^
^: U JO^O~ +
~
JO^O+ q ~ + U J
>1
O^O: ^>
~
JO^OJ
>1
O^O~ ^
M
O^OUJ
>
O^OM J
>1
O^O
C
O+, ^OUJ
>
O^OCO+O>MJ
>1
O^O
~
JO^OJ
>1
O^O
D
O+, ^OUJ
>
O^ODO+OJ
>1
O^O
g
O^OUJ
>
O^OgO^O #
M
O^O: ^C
O+, ^O~ ^D
O+, ^O~ ^g
O^OUJ
>
O^OOpg
o
wO
17
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.3.1 Nonlinear Equations of Motion
(1) M
O^OUM
O^O
0 -^
6
(2) s
~
M
O^O>2C
O+, ^Os U0 -s
6
, +
6
, ^
6
(3) D
O+, ^O 0 -+
6
, ^
6
Properties of the NED Vector Representation
if M UM
0 and
~
M U0.
It should be noted that C
O^O: ^C
O+, ^O~ ^D
O+, ^O~ ^g
O^OUJ
>
O^OOpg
o
wO
18
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.3.1 Nonlinear Equations of Motion
M U
m >X
u~
>X
v~
>X
w~
>X
v~
m >Y
v~
>Y
w~
>X
w~
>Y
w~
m >Z
w~
>X
p~
>mz
g
>Y
p~
my
g
>Z
p~
mz
g
>X
q~
>Y
q~
>mx
g
>Z
q~
>my
g
>X
r~
mx
g
>Y
r~
>Z
r~
>X
p~
mz
g
>X
q~
>my
g
>X
r~
>mz
g
>Y
p~
>Y
q~
mx
g
>Y
r~
my
g
>Z
p~
>mx
g
>Z
q~
>Z
r~
I
x
>K
p~
>I
xy
>K
q~
>I
zx
>K
r~
>I
xy
>K
q~
I
y
>M
q~
>I
yz
>M
r~
>I
zx
>K
r~
>I
yz
>M
r~
I
z
>N
r~
Property (System Inertia Matrix) For a rigid body the system inertia matrix is
strictly positive if and only if M
A
>0, that is:
If the body is at rest (or at most is moving at low speed) under the assumption of
an ideal fluid, the zero-frequency system inertia matrix is always positive definite,
that is
where:
M UM
RB
M
A
0
M UM
0
M 4M
19
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Property (Coriolis and Centripetal Matrix): For a rigid body moving
through an ideal fluid the Coriolis and centripetal matrix can always be
parameterized such that it is skew-symmetric, that is
If M is nonsymmetric, we write M as the sum of a symmetric and skew-
symmetric matrix:
where
This implies that we can compute C from
CO+OU>C
O+O, -+
6
1
2
+
OM>M
O+U0 M 0 T U
1
2
+
M+U
1
2
+
M
-
+0
M U
1
2
OMM
O
1
2
OM>M
O
M
-
UM
-
U
1
2
OMM
O0
M
-
UM
-
0
3.3.1 Nonlinear Equations of Motion
20
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Assumption (Small Roll and Pitch Angles) The roll and pitch angles:
These are good assumptions for vessels where the pitch and roll motions are
limited-i.e., highly metacentric stable vessels
This assumption implies that:
where
3.3.2 Linearized Equations of Motion
-, eare small
^~UJO^O+
-UeU0
4 POO+
POOU
ROO0
33
0
33
I
33
21
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Definition (Vessel Parallel Coordinate System) The vessel parallel coordinate
system is defined as:
where is the NED position/attitude decomposed in body coordinates and P
is given by
Notice that P
T
P = I
66
.
^
p
UP
OO^
^
p
POOU
ROO0
33
0
33
I
33
3.3.2 Linearized Equations of Motion
NED
BODY
^
p
x
b
y
b
x
n
y
n
22
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Low Speed Applications (Station-Keeping)
Vessel parallel (VP) coordinates implies:
3.3.2 Linearized Equations of Motion
^~
p
UP
~
OO^P
OO^~
UP
~
OOPOO^
p
P
OOPOO+
UrS^
p
+ #
where and
r U~
S U
0 1 0 0 0 0
>1 0 0 0 0 0
0 0 0 0 0 0
0 0 0 0 0 0
0 0 0 0 0 0
For low speed applications r 0. This gives a linear model:
^~
p
4+
23
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.3.2 Linearized Equations of Motion
The gravitational and buoyancy forces can also be expressed in terms of VP
coordinates. For small roll and pitch angles:
Notice that this formula confirms that the restoring forces of a leveled vessel
( ) is independent of the yaw angle .
gO^O
-UeU0
4 P
OOG^UP
OOGPOO
G
^
p
UG^
p
-Ue U0
For a neutrally buoyant submersible (W=B) with x
g
=x
b
and y
g
=y
b
we have:
For a surface vessel G is defined as:
G Udiag^0, 0, 0, 0, Oz
g
>z
b
OW, Oz
g
>z
b
OW, 0+
G U
0
22
0
23
0
0
0
32
G
r
0
0
0 0 0 0 0 0
, G
r
U
>Z
z
0 >Z
e
0 >K
-
0
>M
z
0 >M
e
P
OOGPOO^G
Notice that:
24
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Low-Speed Maneuvering and DP: implies that the nonlinear Coriolis,
centripetal, damping, restoring, and buoyancy forces and moments can be
linearized about and . Since C(0)=0 and D
n
(0)=0 it makes
sense to: approximate:
M+~CO+O+
0
D D
n
O+O+
D+
7
gO^O
G^
p
Upg
o
w
^~
p
U+
M+~D+G^
p
Upw
#
#
+40
+U0 -Ue U0
3.3.2 Linearized Equations of Motion
The resulting state-space model becomes:
~ x UAx Bu Ew
A U
0 I
>M
>1
G >M
>1
D
, B U
0
M
>1
, E U
0
M
>1
x U^
p
, +
, u Up
which is the linear time invariant (LTI) state-space model used in DP.
^UPOO^
p
25
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.3.2 Linearized Equations of Motion
Vessels in Transit (Cruise Condition):
For vessels in transit the cruise speed is assumed to satisfy:
This suggests that
where
u Uu
o
NOu
o
OU
+
^CO+O+DO+O++|
+U+
o
+
o
Uu
o
, 0, 0, 0, 0, 0
^~
p
U++
o
M+~NOu
o
O+G^
p
Upw
#
#
+U+>+
o
Linear parameter varying (LPV) model:
~ x UAOu
o
Ox Bu EwF+
o
AOu
o
OU
0 I
>M
>1
G >M
>1
NOu
o
O
, B U
0
M
>1
, E U
0
M
>1
, F U
I
0
x U^
p
, +
26
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Models for ships, semi-submersibles, and underwater vehicles are usually
represented as one of the following subsystemes:
- Surge model: velocity u
- Maneuvering model (sway and yaw): velocities v and r
- Horizontal motion (surge, sway, and yaw): velocities u,v, and r
- Longitudinal motion (surge, heave, and pitch): velocities u,w, and q
- Lateral motion: (sway, roll, and yaw): velocities v,p, and r
or:
- Horizontal plane models: DOFs 1, 2, 6
- Longitudinal motion: DOFs 1, 3, 5
- Lateral motion: DOFs 2, 4, 6
3.5 Standard Models for Marine Vessels
27
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
The horizontal motion of a ship or
semi-submersible is described by
the motion components in surge,
sway, and yaw.
This implies that the dynamics
associated with the motion in heave,
roll, and pitch are neglected, that is
w=p=q=0.
3.5.1 3 DOF Horizontal Motion
+Uu, v, r
^Un, e,
Notice that
34
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.5.2 Decoupled Models for Forward
Speed/Maneuvering
Assume that the ship is controlled by a single rudder:
and that linear damping dominates:
then:
where
pUb U
>Y
>N
DO+OUD D
n
O+O4D
M+~NOu
o
O+Ub
M U
m >Y
v~
mx
g
>Y
r~
mx
g
>Y
r~
I
z
>N
r~
NOu
o
OU
>Y
v
Om >X
u~
Ou
o
>Y
r
OX
u~
>Y
v~
Ou
o
>N
v
Omx
g
>Y
r~
Ou
o
>N
r
b U
>Y
>N
#
#
#
+Uv, r
Y
v~
Y
r~
N
v~
N
r~
+~
Y
v
Y
r
N
v
N
r
+
M+~NOu
o
O+Ub
M U
m >Y
v~
mx
g
>Y
r~
mx
g
>Y
r~
I
z
>N
r~
, NOu
o
OU
>Y
v
mu
o
>Y
r
>N
v
mx
g
u
o
>N
r
, b U
>Y
>N
36
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.5.2 Decoupled Models for Forward
Speed/Maneuvering
1 DOF Autopilot Model (Yaw Subsystem)
A linear autopilot model for course control can be derived from the maneuvering model
by defining the yaw rate r as output:
Hence, application of the Laplace transformation yields (Nomoto 1957):
The 1st-order Nomoto model is obtained by defining the equivalent time constant as:
M+~NOu
o
O+Ub
r Uc
+, c
U0, 1
r
OsOU
KO1T
3
sO
O1T
1
sOO1T
2
sO
2nd-order Nomoto model
T UT
1
T
2
>T
3
r
OsOU
K
O1TsO
OsOU
K
sO1TsO
~Ur
37
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.5.3 Longitudinal and Lateral Models
The 6 DOF equations of motion can in many cases be divided into two non-
interacting (or lightly interacting) subsystems:
- Longitudinal subsystem: states u,w,q, and
- Lateral subsystem: states v,p,r, and
This decomposition is good for slender bodies (large length/width ratio). Typical
applications are aircraft, missiles, and submarines.
e
38
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
yz-plane of symmetry
(fore/aft symmetry)
3.5.3 Longitudinal and Lateral Models
M U
m
11
m
12
0 0 0 m
16
m
21
m
22
0 0 0 m
26
0 0 m
33
m
34
m
35
0
0 0 m
43
m
44
m
45
0
0 0 m
53
m
54
m
55
0
m
61
m
62
0 0 0 m
66
M U
m
11
0 m
13
0 m
15
0
0 m
22
0 m
24
0 m
26
m
31
0 m
33
0 m
35
0
0 m
42
0 m
44
0 m
46
m
51
0 m
53
0 m
55
0
0 m
62
0 m
64
0 m
66
M U
m
11
0 0 0 m
15
0
0 m
22
0 m
24
0 0
0 0 m
33
0 0 0
0 m
42
0 m
44
0 0
m
51
0 0 0 m
55
0
0 0 0 0 0 m
66
xy-plane of symmetry
(bottom/top symmetry):
xz-plane of symmetry
(port/starboard symmetry)
M Udiag^m
11
, m
22
, m
33
, m
44
, m
55
, m
66
+
xz-, yz- and xy-planes of symmetry
(port/starboard, fore/aft and bottom/top
symmetries).
39
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Starboard-port symmetry implies the following zero elements:
The longitudinal and lateral submatrices are:
M U
m
11
0 m
13
0 m
15
0
0 m
22
0 m
24
0 m
26
m
31
0 m
33
0 m
35
0
0 m
42
0 m
44
0 m
46
m
51
0 m
53
0 m
55
0
0 m
62
0 m
64
0 m
66
3.5.3 Longitudinal and Lateral Models
M
long
U
m
11
m
13
m
15
m
31
m
33
m
35
m
51
m
53
m
55
, M
lat
U
m
22
m
24
m
26
m
42
m
44
m
46
m
62
m
64
m
66
40
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Longitudinal Subsystem (DOFs 1, 3, 5)
3.5.3 Longitudinal and Lateral Models
R
b
n
O`OU
cce >sc-cses- ss-cc-se
sce cc-s-ses >cs-sesc-
>se ces- cec-
T
`
O`OU
1 s-te c-te
0 c- >s-
0 s-/ce c-/ce
JO^OU
R
b
n
O`O 0
33
0
33
T
`
O`O
d
~
e
~
U
cos e 0
0 1
w
q
>sine
0
u
v, p, r, -are small
not controlling the N-position
using speed control instead
Resulting kinematic equation:
41
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Longitudinal Subsystem (DOFs 1, 3, 5)
For simplicity, it is assumed that higher order damping can be neglected, that is
. Coriolis is, however, modelled by assuming that and that
2nd-order terms in v,w,p,q, and r are small. Hence, DOFs 1, 3, 5 gives:
Assuming a diagonal M
A
gives:
3.5.3 Longitudinal and Lateral Models
D
n
O+OU0 u 0
C
RB
O+O+4
0 0 0
0 0 >mu
0 0 mx
g
u
u
w
q
C
RB
O+O+U
mOy
g
q z
g
rOp >mOx
g
q >wOq >mOx
g
r vOr
>mOz
g
p >vOp >mOz
g
q uOq mOx
g
p y
g
qOr
mOx
g
q >wOu >mOz
g
r x
g
pOv mOz
g
q uOw OI
yz
q I
xz
p >I
z
rOp O>I
xz
r >I
xy
q I
x
pOr
Collecting terms in u,w, and q, gives:
C
RB
O+O4>C
RB
O+O
The skew-symmetric property is
destroyed for the decoupled model:
C
A
O+O+U
>Z
w~
wq Y
v~
vr
>Y
v~
vp X
u~
uq
OZ
w~
>X
u~
Ouw ON
r~
>K
p~
Opr
4
0 0 0
0 0 X
u~
u
0 OZ
w~
>X
u~
Ou 0
u
w
q
42
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Longitudinal Subsystem (DOFs 1, 3, 5)
The restoring forces with W=B and x
g
=x
b
:
3.5.3 Longitudinal and Lateral Models
gO^OU
OW>BOsine
> OW>BOcos esin-
> OW>BOcos ecos -
> Oy
g
W>y
b
BOcos ecos - Oz
g
W>z
b
BOcos esin-
Oz
g
W>z
b
BOsine Ox
g
W>x
b
BOcos ecos -
> Ox
g
W>x
b
BOcos esin- > Oy
g
W>y
b
BOsine
gO^OU
0
0
WBG
z
sine
43
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.5.3 Longitudinal and Lateral Models
Longitudinal Subsystem (DOFs 1, 3, 5)
m >X
u~
>X
w~
mz
g
>X
q~
>X
w~
m >Z
w~
>mx
g
>Z
q~
mz
g
>X
q~
>mx
g
>Z
q~
I
y
>M
q~
u~
w~
q~
>X
u
>X
w
>X
q
>Z
u
>Z
w
>Z
q
>M
u
>M
w
>M
q
u
w
q
0 0 0
0 0 >Om >X
u~
Ou
0 OZ
w~
>X
u~
Ou mx
g
u
u
w
q
0
0
WBG
z
sine
U
p
1
p
3
p
5
m >Z
w~
>mx
g
>Z
q~
>mx
g
>Z
q~
I
y
>M
q~
w~
q~
>Z
w
>Z
q
>M
w
>M
q
w
q
0 >Om >X
u~
Ou
o
OZ
w~
>X
u~
Ou
o
mx
g
u
o
w
q
0
BG
z
Wsine
U
p
3
p
5
#
u Uu
o
Uconstant
44
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.5.3 Longitudinal and Lateral Models
Longitudinal Subsystem (DOFs 1, 3, 5)
Linear pitch dynamics (decoupled):
where the natural frequency is:
OI
y
>M
q~
Oe
:
>M
q
e
~
BG
z
We Up
5
_
e
U
BG
z
W
OI
y
>M
q~
O
45
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Lateral Subsystem (DOFs 2, 4, 6)
3.5.3 Longitudinal and Lateral Models
R
b
n
O`OU
cce >sc-cses- ss-cc-se
sce cc-s-ses >cs-sesc-
>se ces- cec-
T
`
O`OU
1 s-te c-te
0 c- >s-
0 s-/ce c-/ce
JO^OU
R
b
n
O`O 0
33
0
33
T
`
O`O
not controlling the E-position
using heading control instead
Resulting kinematic equation:
-
~
Up
~Ur
#
#
u, w, p, r, -and eare small
46
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Lateral Subsystem (DOFs 2, 4, 6)
Again it is assumed that higher order velocity terms can be neglected so that
. Hence:
Assuming a diagonal M
A
gives:
3.5.3 Longitudinal and Lateral Models
D
n
O+OU0
Collecting terms in v,p, and r, gives:
C
RB
O+O4>C
RB
O+O
The skew-symmetric property is
destroyed for the decoupled model:
C
RB
O+O+U
>mOy
g
p wOp mOz
g
r x
g
pOq >mOy
g
r >uOr
>mOy
g
q z
g
rOu mOy
g
p wOv mOz
g
p >vOw O>I
yz
q >I
xz
p I
z
rOq OI
yz
r I
xy
p >I
y
qOr
mOx
g
r vOu mOy
g
r >uOv >mOx
g
p y
g
qOw O>I
yz
r >I
xy
p I
y
qOp OI
xz
r I
xy
q >I
x
pOq
C
RB
O+O+4
0 0 mu
o
0 0 0
0 0 mx
g
u
o
v
p
r
C
A
O+O+U
Z
w~
wp >X
u~
ur
OY
v~
>Z
w~
Ovw OM
q~
>N
r~
Oqr
OX
u~
>Y
v~
Ouv OK
p~
>M
q~
Opq
4
0 0 >X
u~
u
0 0 0
OX
u~
>Y
v~
Ou 0 0
v
p
r
47
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
Lateral Subsystem (DOFs 2, 4, 6)
The restoring forces with W=B, x
g
=x
b
and y
g
=z
g
:
gO^OU
OW>BOsine
> OW>BOcos esin-
> OW>BOcos ecos -
> Oy
g
W>y
b
BOcos ecos - Oz
g
W>z
b
BOcos esin-
Oz
g
W>z
b
BOsine Ox
g
W>x
b
BOcos ecos -
> Ox
g
W>x
b
BOcos esin- > Oy
g
W>y
b
BOsine
3.5.3 Longitudinal and Lateral Models
gO^OU
0
WBG
z
sin-
0
48
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.5.3 Longitudinal and Lateral Models
Lateral Subsystem (DOFs 2, 4, 6)
u Uu
o
Uconstant
m >Y
v~
>mz
g
>Y
p~
mx
g
>Y
r~
>mz
g
>Y
p~
I
x
>K
p~
>I
zx
>K
r~
mx
g
>Y
r~
>I
zx
>K
r~
I
z
>N
r~
v~
p~
r~
>Y
v
>Y
p
>Y
r
>M
v
>M
p
>M
r
>N
v
>N
p
>N
r
v
p
r
0 0 Om >X
u~
Ou
0 0 0
OX
u~
>Y
v~
Ou 0 mx
g
u
v
p
r
0
WBG
z
sin-
0
U
p
2
p
4
p
6
m >Y
v~
mx
g
>Y
r~
mx
g
>Y
r~
I
z
>N
r~
v~
r~
>Y
v
>Y
r
>N
v
>N
r
v
r
0 Om >X
u~
Ou
o
OX
u~
>Y
v~
Ou
o
mx
g
u
o
v
r
U
p
2
p
6
#
49
TTK 4190 Guidance and Control (T. I. Fossen) Lecture Notes 2005
3.5.3 Longitudinal and Lateral Models
Lateral Subsystem (DOFs 2, 4, 6)
Linear roll dynamics (decoupled):
where the natural frequency is:
OI
x
>K
p~
O-
:
>K
p
-
~
WBG
z
-Up
4
_
-
U
BG
z
W
OI
x
>K
p~
O