Professional Documents
Culture Documents
Abstract. Nonlinear tracking of ships in terms of way-points for route planning is discussed. A
tracking control law that handles dierent curvatures of a path, e.g. combinations of straight-lines
and circles, is developed by using nonlinear backstepping. Exponential stability is proven by applying
Lyapunov stability theory. An extension to integral action is also made. However, only convergence
is guaranteed for the case when integral action is included.
Key Words. Way-Point Tracking, Guidance of Ships, Marine Systems, Ship Control, Nonlinear
Backstepping.
The WOP will now, however, not indicate the Fig. 3. Coordinate system describing the ship motion
start of the turning maneuver. This is because where is the heading angle, u is the forward
it is impossible to be on the prescribed circle path velocity, v is the sway velocity and U is the
and at the same time increase the yaw rate. It is total speed.
then proposed in Holzhuter and Schultze (1995)
to use a model-based track construction. Instead where r is the yaw rate, is the rudder angle and
of starting the turning maneuver at the WOP, a K and T are two constants. Because the path of
new model-based wheel over point (WOPin) is de- a ship consists of both straight line segments and
ned about one ship length before the WOP. By circle segments, two ways of motion will be con-
the time the ship passes the WOP, it will have sidered, straight line motion and radial motion.
the right yaw rate. However, the ship will now
not be able to intersect the WOP and, hence, the
circle path of the ship will dier from the one pre-
scribed. In other words, the circle center will be 3.1. Straight-Line Motion
shifted by some meters. When the ship is about The kinematic relations according to Figure 3 give
to leave the circle, counter-rudder is applied by the full state-space model in straight-line motion:
the time the ship passes the model-based wheel
over point WOPout. The ship will then reach the x_ = u cos ? v sin
straight line segment with zero yaw rate. Figure 2 y_ = u sin + v cos (2)
taken from Holzhuter and Schultze (1995) shows _ = r
the principles.
pi
p cruise condition: u 0 and v 0. Hence
During
U = u2 + v2 u, such that (2) in combination
+
(3)
r_ = ar + b
where a = ?1=T and b = K=T .
Fig. 2. Illustration showing the placements of the
WOP, WOPin and WOPout , and the path of
the ship versus the prescribed circle path. 3.2. Radial Motion:
By applying polar coordinates the (x; y) coordi-
nates of a circle with radius R and angle increment
can be written:
3. SHIP MODEL
x = x0 + R cos
The ship dynamics is described by Nomoto 1st-
order model (Nomoto et al., 1957): y = y0 + R sin
(4)
1 K where (x0 ; y0 ) is the center of the circle which
r_ = ? r + (1) must be shifted for each way-point. Time dier-
T T
4.3. Nonlinear Backstepping To make V_2 negative denite (except from the cou-
pling term between z2 and z3 ) 2 is chosen as:
During the development of the way-point tracking
control law it is convenient to dene 4 states: x1 = 2 (x1 ; x2 ; x4 ; yd; y_d; yd ) =
~ x2 = ; x3 = r and x4 =
. Hence (7) can be
R;
U2
U sin(x4 ?x2 ) ?s x1 +Rd sin (x4 ? x2 ) (19)
1 2
written as:
P2 @ (i)
x_ 1 = U cos(x4 ? x2 ) ? R_ d ?c2 z2 ? z1 + @
@x x_ 1 + i=1 @y i? yd
1
1 (
1
1)
d
x_ 2 = x3 (10)
x_ 3 = ax3 + b where c2 > 0 and:
U @1 @2 @2
x_ 4 = ?s sin(x4 ? x2 ) = ?c1 ; = c1 ; =1
x +R1 d @x1 @yd @ y_d
where Rd > 0 is given by (8). The development of The expression for V_2 is then:
the tracking control law consists of three iterative
steps: V_2 = ?c1z12 ? c2 z22 + Uz2z3 sin(x4 ? x2 ) (20)
Step 1. Two error variables z1 and z2 are dened
as: Step 3. The expression for z_3 is:
z1 = x 1 ? y d @2 @ @
(11) z_3 = ax3 + b ? x_ 1 ? 2 x_ 2 ? 2 x_ 4
z2 = U cos(x4 ? x2 ) ? 1 (12) @x1 @x2 @x4
X3
@2 (i)
Stabilizing (11) with respect to the control Lya- ? (i?1) yd (21)
punov function (clf) V1 = 12 z12 gives: i=1 @yd
The last clf is introduced as V3 = V2 + 21 z32. V_3
V_1 = z1 (z2 + 1 ? R_ d ? y_d) (13) is:
Choosing 1 as: V_3 = ?c1z12 ? c2 z22
1 (x1 ; yd ; y_d) = ?c1 z1 + y_d + R_ d (14) +z3 Uz2 sin(x4 ? x2 ) + ax3 + b ? @
@x x_ 1
2
1
where c1 > 0 yields: P3 @ (i)
? @ 2
@
@x x_ 2 ? @x x_ 4 ? i=1 @y i? yd (22)
2 2
4 (
2
1)
d
V_1 = ?c1 z12 + z1 z2 (15)
4.4. Control Law
Step 2. The third error variable z3 is introduced:
The control input is chosen such that V_3 becomes
z3 = x 3 ? 2 (16) negative denite:
The derivative of z2 is:
=
1 ?c z ? Uz sin(x ? x ) ? ax + @2 x_
b 3 3 2 4 2 3 @x1 1
z_2 = ? U sin(x4 ? x2 ) 3 !
X
?s x +U R sin(x4 ? x2 ) ? x3 + @ 2 x_ + @2 x_ +
@x 2 @x 4
@2 (i)
(i?1) yd (23)
1 d 2 4 i=1 @yd
−2
800
[m]
−4
600 −6
Lattitude [m]
−8
0 50 100 150 200 250
400 Time [sec]
−4
x 10
1
200 0.5
[m]
0
0
−0.5
0 200 400 600 800 1000
Longitude [m]
−1
0 50 100 150 200 250
Time[sec]
[m]
−0.2
100
−0.4
[deg]
50
−0.6
0 50 100 150 200 250
Time[sec]
0
0 50 100 150 200 250
Time [sec] 40
1.5
30
[deg/sec]
1
20
[deg]
0.5 10
0 0
0 50 100 150 200 250
Time [sec] −10
50
−20
0 50 100 150 200 250
Time [sec]
[deg]