Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
discussions, stats, and author profiles for this publication at: https://www.researchgate.net/publication/223864557
CITATIONS
READS
50
154
2 authors, including:
Jing Sun
University of Michigan
198 PUBLICATIONS 4,300 CITATIONS
SEE PROFILE
ARTICLE IN PRESS
Ocean Engineering 37 (2010) 289295
Ocean Engineering
journal homepage: www.elsevier.com/locate/oceaneng
a r t i c l e in fo
abstract
Article history:
Received 2 April 2009
Accepted 25 October 2009
Available online 3 November 2009
This paper presents a model predictive control (MPC) for a way-point tracking of underactuated surface
vessels with input constraints. A three-degree-of-freedom dynamic model of surface vessels has been
used for the controller design. In order for the control action to render good helmsman behavior, a MPC
scheme with line-of-sight (LOS) path generation capability is formulated. Quadratic programming (QP)
is used to solve a linear MPC by successive linearization along the LOS model of the surface vessel.
Furthermore, we show that an LOS decision variable can be incorporated into the MPC design to
improve the path following performance. The effectiveness of the developed control law is
demonstrated via computer simulations.
& 2009 Elsevier Ltd. All rights reserved.
Keywords:
Line-of-sight guidance
Ship path following
Model predictive control
1. Introduction
Trajectory tracking and path following of surface ships have
been a long standing control problem that have attracted
attention from the control community for many years. The
under-actuated nature of these problems, namely with more
variables to be controlled than the number of control actuators,
coupled with the nonlinear characteristics of the hydrodynamics
associated with the ship motion, makes the control problem both
interesting and challenging.
The underactuated ship motion control problem has been
tackled in a number of research studies in the last few years. For
example, the recursive technique proposed in Jiang and Nijmeijer
(1999) for the standard chain form systems is used in Pettersen
and Nijmeijer (2001) to provide a local tracking result. By
applying the cascaded approach, a global tracking result was
obtained in Breivik and Fossen (2004) and Lefeber (2000), where
the stability analysis is performed relying on the theory of linear
time varying systems. Using backstepping and Lyapunovs direct
method, a controller is developed that guarantees global exponential stability of straight line and circle trajectories (Do et al.,
2002). Path following approach based on a line-of-sight (LOS)
algorithm, which is often used in a way-point ship control
practice, is presented in Pettersen and Lefeber (2001). In Fantoni
et al. (2002), a simplied ship model has been examined based on
passivity considerations and Lyapunov theory, discontinuous
$
This work was supported by ONR under Grant N00014-05-1-0537 and
N00014-06-1-0879.
Corresponding author.
E-mail addresses: srohum@umich.edu (S.-R. Oh), jingsun@umich.edu (J. Sun).
0029-8018/$ - see front matter & 2009 Elsevier Ltd. All rights reserved.
doi:10.1016/j.oceaneng.2009.10.004
ARTICLE IN PRESS
290
For surface vessels operating in the open sea, the path is often
a straight line or way-point path, which consists of piecewise
straight lines. In these cases, the path curvature is zero, therefore
the path following error dynamics could be simplied into
e_ usinc vcosc ;
c_ r;
c LOS p :
e2 D2
ARTICLE IN PRESS
S.-R. Oh, J. Sun / Ocean Engineering 37 (2010) 289295
291
7
T
p
angle expression (c LOS ke, k 1= e2 D2 40) over arctanlike functions has been elaborated in Li et al. (2009b).
In the ship path following literature, D is typically expressed as
a distance of n ship length nLship (Breivik, 2003).
We consider a generic desired geometric path composed of a
collection of way-points . . . ; Pk1 ; Pk ; Pk 1 ; . . .. The LOS position
PLOS is a point located somewhere along the straight line segment
connecting the previous way-point (Pk1 ) and current way-point
(Pk ). The position PLOS moves along the line as the ship is
approaching the desired path. A criteria for switching to the next
way-point, located at Pk 1 , is for the ship to be within a circle of a
radius Rk of the current way-point Pk . The guideline to choose Rk is
examined in Breivik (2003). In our simulation, Rk is assumed to be
equal to two ship lengths, that is Rk 2Lship as shown in Moreira
et al. (2007).
If a ship heading follows exactly what is specied by the LOS
algorithm Eq. (3), one can establish the desired path following
performance. Note, from Eq. (2), that
v
e_ usinc vcosc Usin c arctan ;
4
u
p
where U u2 v2 40. If the heading of the ship c is made to
satisfy
c arctan
v
c LOS ;
u
e_ usinc LOS
sinc LOS
where f x;r and f u;r are the partial derivatives of f with respect to x
and u, respectively, evaluated around the reference point xr ; ur .
x~ x xr represents the error with respect to the reference
points and u~ u ur is its associated control input.
The approximation of x_~ using forward differences gives the
following discrete-time system model:
x~ k 1 Ak x~ k Bk u~ k ;
with
2
1
6
60
Ak 6
60
4
0
2
0
T
Ucoscr kT
1
sincr kT
0
1 av T
ar T
bv T
1 br T
3
7
7
7;
7
5
3
10
c LOS
U
sinc LOS
p
er 0;
e2 D2 c LOS
~
x_~ f x;r x~ f u;r u;
7
6
6 0 7
7
Bk 6
6 Y d T 7:
5
4
Nd T
we have
U c LOS
where x e c v r and u d.
A linear model of the system dynamics can be obtained by
computing an error model with respect to reference signals
xr 0; c LOS ; 0; 0T and ur 0. Note that we assumed xr 3; 1 0 to
simplify the derivation of the linear MPC where xr 3; 1 stands for
the third component of the reference signals. This property
approximately holds for D b jej and jv=Uj5 1. x_ r fxr ; ur also
holds under this assumption. The linear model of Eq. (7) will take
the form:
c LOS A p; p;
Fk
N
X
T
T
x~ k j Q x~ k j u~ k j1 Ru~ k j1 ;
11
j1
12
ARTICLE IN PRESS
292
Fk 12u Tk Hk u k fkT u k dk ;
13
with
fk 2B k Q A k x~ k ;
14
dk x~ k A k Q A k x~ k ;
Bk
Ak 1 Bk
Bk 1
^
Ak N1 Bk 1
&
Ak N1 Bk
Bk N1
2
"
3
7
7
7:
7
5
16
1 3
ek
T
6
B
C 7
L k cA 7
2B k Q A k @xk q
#T 6
7
6
7
6
e2k D2
7
6
7
6
lk
2
7
6
ek
2ek
6 q
Mk xk 2
Mk L k c 7
5
4
2
2 D
2
2
e
ek D
k
uk
e2k
e2k D2
ek
T
Mk xk xTk A k Q A k xk ;
Mk L k c 2q
2
2
ek D
18
c~ LOS 1 l k q
e2k D2
3
ek
T
q
Bk Q Lkc
2
7
e2k D
7"
#
7 uk
7
7
7 lk
e2k
7
L
M
L
c
5
k k
2
2
ek D
15
j1
B Q B k R
6 k
"
#T 6
uk 6
1T
60
Fk
6
lk
6B
ek
T
6 @q
B k Q L k cC
A
4
2
2
ek D
u k u~ k ; . . . ;
Q diagQ ; ; Q ,
R diagR; ; R,
where
T
u~ k N1 T , and A k and B k are given by
3
2
Ak
7
6
Ak 1 Ak
7
6
7;
Ak 6
7
6
^
5
4
Ak N1 Ak
6
6
Bk 6
6
4
ek
0; 1; 0; 0T ;
xr;k xr;N 1 l k q
|{z}
2
ek D2
c
Hk 2B k Q B k R;
Mk L k cT A k Q A k ;
2
Ak I44
6
6
Lk 6
6
4
Ak 1 Ak I44
^
Ak N1 Ak I44
7
7
7;
7
5
2 3
0
617
6 7
c 6 7:
405
z}|{
2
0
1T
3
T
e2k
ek
ek
T
6 T
B
C
7
B k Q L k c@q
B Q L k cA L
4 B k Q B k R q
Mk L k c 5
2 D2
2
2
2
2
e
ek D
ek D
k
k
"
uk
lk
"
uk
#T
lk
|{z}
u
z}|{
2
11
3
0 0
e2k
ek
2ek
T B
6
B
CC
7
L k cAA q
Mk xk 2
4 2B k Q @A k @xk q
Mk L k c5
2
2
2
ek D2
e2k D
e2k D
20
which can be readily solved using standard optimization software. When the constraints are not active, the optimal solution is
computed by u 12 H1 f where the condition H 40 is equivalent to (refer to Boyd et al., 1994)
T
j1
where L is a constant weighting factor. Note that for the xed LOS
lookahead distance, we have l k 0.
Since the last three terms in Eq. (18) are independent of u k ; l k , the
optimal solution remains the same if we replace the cost function
by
"
#T
uk
Fk0
lk
R B k Q B k Vk Tk1 VkT 4 0;
17
19
where
Tk L
e2k
2
ek D2
L k cT A k Q A k L k c
21
ARTICLE IN PRESS
S.-R. Oh, J. Sun / Ocean Engineering 37 (2010) 289295
and
Table 1
Model ship principal particulars.
Item
Symbol
Value
Length
Breadth
Height
Mass
Inertia
Nominal speed
L
B
H
m
Iz
un
1.6 m
0.38 m
0.17 m
30
0:3 kg m2
0.4 m/s
Table 2
Experimentally identied parameters.
Xu_
Xuju
Yv_
Yjvjv
Nv
Yr_
Yjrjr
Yjrjv
Nr_
Njrjr
Yd
Nd
6.8558
12.9059
17.5
24.2
1.1965
0.0
0.63
0.14
1.2
0.3302
1:8902 105
0.01
293
ek
T
B k Q A k L k c:
Vk q
2
2
ek D
Eq. (21) is equivalent to
T
R Bk Q Bk
B k Q A k LcB k Q A k LcT
T
L1 LcT A k Q
4 0:
Xu
Xuuu
Yv
Nv_
Njvjv
Yr
Yjvjr
Nr
Njvjr
Njrjv
Yd
3.0211
2.7759
20.5
0
0.0016
0.835
0.0
1.2522
0.1
0.04
0.022
22
A k Lc
23
with
F Q
1
P A k Lc;
T PT ;
G L1
1
24
R B k Q
1
1
T
A k LcL1
Bk 40:
1 c L Ak
25
Fig. 5. Ship motion variables for LOS-based MPC (with xed lookahead distance, dashed line) and non-LOS MPC (solid line) schemes.
26
ARTICLE IN PRESS
294
Yh Yr_ r_ Yv_ v_ Yv v Yr r Yjvjv jvjv Yjvjr jvjr Yjrjv jrjv Yjrjr jrjr;
27
Nh Nr_ r_ Nv_ v_ Nv v Nr r Njvjv jvjv Njvjr jvjr Njrjv jrjv Njrjr jrjr:
28
The mathematical model is discretized with a sampling time
Ts 0:5 s. Two different simulations are carried out to illustrate the
effectiveness of the LOS based MPC design: First, the LOS based MPC
is compared with its counterpart non-LOS MPC. Second, the LOS
parameter is further used as a decision variable along with the
Fig. 6. Trajectory of the model ship in the xy plane with xed LOS (dashed line)
and variable LOS (solid line) MPC path following control.
Fig. 7. LOS parameter, cross tracking error, and the rudder deection angle for xed LOS (dashed line) and variable LOS (solid line) MPC schemes.
ARTICLE IN PRESS
S.-R. Oh, J. Sun / Ocean Engineering 37 (2010) 289295
5. Conclusions
This paper proposed an MPC design method, aiming at
integrating an LOS guidance algorithm with a path following
control for surface vessels. The choice of MPC for this application
is primarily motivated by the need to explicitly handle constraints
in the form of rudder saturation and rudder rate limit. The LOS
guidance to mimic a good helmsman behavior was incorporated
into the MPC design in order to generate reference trajectories for
the ship to follow. The solution of the optimization problem
through a standard QP solver was shown to be effective in
achieving path following for vessels in the presence of input
constraints. The simulation results showed that the MPC
controllers combined with the LOS guidance scheme outperformed those obtained using MPC method alone. Moreover,
incorporating the LOS lookahead variable as a design variable in
MPC optimization provided an additional degree of freedom in
shaping the path following control performance. Numerical
simulations also conrmed the benets of the variable LOS
scheme.
295
References
Abkowitz, M.A., 1964. Lectures on ship hydrodynamics-steering and maneuverability. Technical Report, Lyngby, Denmark.
Bertram, V., 2000. Marine Engineering: Practical Ship Hydrodynamics. Butterworth-Heinemann, Oxford, UK, ISBN:0-7506-4851-1.
Boyd, S., Ghaoui, L.E., Feron, E., Balakrishnan, V., 1994. Linear Matrix Inequalities in
System and Control Theory. In: SIAM Studies in Applied Mathematics, vol. 15.
Breivik, M., 2003. Nonlinear maneuvering control of underactuated ships. Master
Thesis, NTNU.
Breivik, M., Fossen, T.I., 2004. Path following for marine surface vessels. In: Oceans
04. MTS/IEEE Techno-Ocean04, vol. 4, pp. 22822288.
Do, K.D., Jiang, Z.P., Pan, J., 2002. Universal controllers for stabilization and tracking
of underactuated ships. Systems & Control Letter 47, 299317.
Fantoni, I., Lozano, R., Mazenc, F., Pettersen, K.Y., 2002. Stabilization of a nonlinear
underactuated hovercraft. International Journal of Robust Nonlinear Control
10 (8), 645654.
Fossen, T.I., 2002. Marine Control Systems: Guidance, Navigation and Control of
Ships, Rigs and Underwater Vehicles, Marine Cybernetics AS. Trondheim,
Norway.
Jiang, Z.P., Nijmeijer, H., 1999. A recursive technique for tracking control of
nonholonomic systems in chained form. IEEE Transactions on Automatic
Control 44, 265279.
Lefeber, E., 2000. Tracking control of nonlinear mechanical systems. Ph.D. Thesis,
University of Twente.
Li, Z., Sun, J., Oh, S., 2009a. Path following for marine surface vessels with rudder
and roll constraints: an mpc approach. In: American Control Conference, Paper
ThC11.6.
Li, Z., Sun, J., Oh, S.-R., 2009b. Design, analysis and experimental validation of
robust nonlinear path following control of marine surface vessels. Automatica
45, 16491658.
Marjanovi, O., Lennox, B., 2004. Innite horizon model predictive control with no
terminal constraint. Computers and Chemical Engineering 28, 26012610.
Moreira, L., Fossen, T.I., Soares, C.G., 2007. Path following control system for a
tanker ship model. Ocean Engineering 34, 20742085.
Oh, S., Sun, J., Li, Z., 2009. Development of free-running model ship for system
identication and control development. ASME/IEEE Transactions on Mechatronics, accepted for publication.
Perez, T., Fossen, T.I., 2004. A discussion about sea keeping and maneuvering
models for surface vessels. Technical Report MSS-TR-001, Marine System
Simulator, NTNU.
Perez, T., 2005. Ship Motion Control: Course Keeping and Roll Stabilisation Using
Rudder and Fins. Springer, Berlin.
Pettersen, K.Y., Nijmeijer, H., 2001. Underactuated ship tracking control: theory
and experiments. International Journal of Control 74 (14), 14351446.
Pettersen, K.Y., Lefeber, E., 2001. Way-point tracking control of ships. In:
Proceedings of the 40th IEEE Conference on Decision and Control, pp. 940945.
Wahl, A., Gilles, E., 1998. Track-keeping on waterways using model predictive
control. Control Applications in Marine Systems.