Tracking Control of Marine Craft in the port-Hamiltonian Framework:
A Virtual Differential Passivity Approach

arXiv:1803.07938v1 [] 21 Mar 2018

Rodolfo Reyes-Báez, Alejandro Donaire, Arjan van der Schaft, Bayu Jayawardhana, Tristan Pérez
Abstract— In this work we propose a family of trajectory
tracking controllers for marine craft in the port-Hamiltonian
(pH) framework using virtual differential passivity based control
(v-dPBC). Two pH models of marine craft are considered, one
in a body frame and another in an inertial frame. The structure
and workless forces of pH models are exploited to design
two virtual control systems which are related to the original
marine craft’s pH models. These virtual systems are rendered
differentially passive with an imposed steady-state trajectory,
both by means of a control scheme. Finally, the original marine
craft pH models in closed-loop with above controllers solve the
trajectory tracking problem. The performance of the closedloop system is evaluated on numerical simulations.

I. INTRODUCTION
The recent advances of incremental methods in systems
and control have enabled the development of new control
paradigm [12], [18], [15], [11], [5]. The extension to open
systems of differential Lyapunov framework for contraction
analysis [5], the so-called differential passivity [20], [6]
resembles the relation between standard passivity property
and Lyapunov stability. In other words, the fact that differential passivity implies contraction (with zero input), is
analogous to the fact that passivity implies Lyapunov stability
(also with zero input). This gives us the possibility of
exploiting systems’s interconnection properties in a differential passivity preserving manner [20]. Contraction analysis
(respectively, differential passivity) has been generalized by
considering contracting (respectively, differentially passive)
virtual systems [23], [11], [5] whose input is given by the
state of the original systems and whose solutions include all
state trajectories of the original system. Roughly speaking,
when a virtual system is in cascade with the original system1
and when both states are initialized at the same point then
both systems produce identical state trajectories.
The latter approach has motivated us to propose virtual
differential passivity-based control (v-dPBC) methods where
we combine the concept of virtual systems and of differential
passivity for designing stabilizing/tracking controllers [17].
The v-dPBC method consists basically of three main steps.
In the first step, we need to define an admissible virtual
R. Reyes-Báez, B. Jayawardhana and A.J. van der Schaft are with
the Jan C. Willems Center for Systems and Control, Faculty of Science
and Engineering, University of Groningen, Nijenborgh 9, 9797AG Groningen, The Netherlands. {r.reyes-baez, b.jayawardhana,

a.j.van.der.schaft}@rug.nl
A. Donaire and T. Pérez are with the Institute for Future Environments and School of Electrical Eng. and Comp. Sc., Queensland University of Technology, Australia. {alejandro.donaire,

tristan.perez}@qut.edu.au
1 In this case, the input of virtual system is connected to the state of
original system.

control system (the precise definition of this will come later).
Subsequently, in the second step, we design a controller such
that the closed-loop virtual system is differentially passive
and has a desired steady-state behaviour or trajectory. Finally,
in the third step, we close the loop of the original system
using the control law from the previous step where the
virtual state is replaced by the original state. The method was
applied to fully-actuated [16] and underactuated mechanical
systems [17]. In this paper, we extend these results to marine
craft systems which are rigid bodies on moving frames.
The dynamic models of marine craft and hydrodynamic
forces possess intrinsic passivity properties inherited from its
physical nature [8], [7]. These properties have been widely
used for motion control design of ships and underwater
vehicles, see for example [9], [19], [25]. In the same spirit,
port-Hamiltonian models for marine craft have been proposed and used for (robust) passivity-control design in a
structure preserving manner, for further details see [3], [4]
and reference therein. Specifically, in [4], two pH models
of marine vehicle dynamics are presented, one in body-fixed
coordinates and another in inertial coordinates. The model
in body-coordinates is later used for designing a robust passivity based tracking control scheme. However, the tracking
problem for the inertial-coordinates model remains an open
problem. From a practical point of view, the relation of these
two models is very useful since the attitude and velocities
are usually measured by IMU (Inertial Measurement Unit)
and GPS (Global Position System) sensors which means that
the obtained measurements are in the body-fixed frame.
In this work we solve the trajectory tracking problem of
marine craft via the v-dPBC design method for both pH
models in [4]. The paper is organized as follows: in Section
II we present the preliminaries that are used through the
paper, in Section III the notation and standard nomenclature
for marine vessels is introduced together with a note on the
dynamics in inertial frame that is later used for expressing
explicitly the workless forces of the marine craft in the body
and inertial frame. In Section IV we state the main results
on the v-dPBC approach for solving the tracking problem.
The performance of a v-dPBC scheme is shown Section V,
although due to the limited number of pages, it is briefly
described.
II. PRELIMINARIES
A. Contraction, differential passivity and virtual systems
We adopt the differential analysis framework of [5]. Some
functions arguments will be omitted due to space limitation.

1) Differential analysis: contraction and passivity: Let Σ
be a nonlinear control system with state space X be the
state-space of dimension N, affine in the input u,

ẋ = f (x,t) + ∑ni=1 gi (x,t)ui ,
Σu :
(1)
yi = h(x,t),

where x ∈ X , u ∈ U ⊂ Rn and y ∈ Y . The vector fields
f , gi : X × R≥0 → T X are assumed to be smooth and h :
X × R≥0 → Y . The input space U and output space Y are
assumed to be open subsets of Rn . System (1) in closed-loop
with the smooth static feedback control law u = γ (x,t) will
be denoted by

ẋ = F(x,t),
Σ:
(2)
y = h(x,t),
The variational system along the trajectory (u, x, y)(t) is
the time-varying system given by
(
δ ẋ = ∂∂ xf (x,t)δ x + ∑ni=1 ui ∂∂gxi (x,t)δ x + ∑ni=1 gi δ ui ,
(3)
δ y = ∂∂ hx (x,t)δ x.
Definition 1 ([2]): The prolonged system of Σu in (1),
corresponds to system described by
ẋ = f (x,t) + ∑ni=1 gi (x,t)ui ,
y = h(x,t),
δ ẋ = ∂∂ xf (x,t)δ x + ∑ni=1 ui ∂∂gxi δ x + ∑ni=1 gi (x,t)δ ui ,
δ y = ∂∂ hx (x,t)δ x.

(4)

The prolonged system is (2) is

ẋ = F(x,t),


 y = h(x,t),
(5)
 δ ẋ = ∂∂Fx (x,t)δ x,


δ y = ∂∂ hx (x,t)δ x.
Definition 2 ([5]): A function V : T X × R≥0 → R≥0 is
a candidate differential or Finsler-Lyapunov function if it
satisfies the bounds
c1 F (x, δ x,t) p ≤ V (x, δ x,t) ≤ c2 F (x, δ x,t) p ,

(6)

where c1 , c2 ∈ R>0 , p is a positive integer and F (x, ·,t) :=
k · kx,t is a Finsler structure, uniformly in t.
Definition 3: Consider a candidate differential Lyapunov
function on X and the associated Finsler structure F . For
any subset C ⊆ X and any x1 , x2 ∈ C , let Γ(x1 , x2 ) be the
collection of piecewise C1 curves γ : I → X connecting
γ (0) = x1 and γ (1) = x2 . The Finsler distance d : X × X →
R≥0 induced by F is defined by


Z
∂γ
(7)
d(x1 , x2 ) := inf
F γ (s), (s),t ds.
∂s
Γ(x1 ,x2 ) γ
The following result gives a sufficient condition for contraction in terms of differential Lyapunov functions
Theorem 1: Consider system (5), a connected and forward
invariant set C ⊆ X , and a function α : R≥0 → R≥0 . Let V
be a candidate differential Lyapunov function satisfying
V̇ (x, δ x,t) ≤ −α (V (x, δ x,t))

(8)

for all (x, δ x) ∈ T X and all t > t0 . Then, system (2) is
• incrementally stable (IS) if α (s) = 0 for each s ≥ 0;

asymptotically IS if α is of class K ;
exponentially IS with rate β if α (s) = β s, ∀s ≥ 0.
Definition 4 (Contracting system): We say that Σ contracts V in C if (8) is satisfied for α of class K . Function V
is the contraction measure, and C is the contraction region.
In analogy to the standard notion of dissipativity [24], [21],
the differential Lyapunov framework for contraction analysis
was extended to open systems [6], [20].
Definition 5 ([20]): Consider a control system Σu in (1)
together with its prolonged system (4). Then, Σu is called
differentially passive if there exist a differential storage
function function W : T X → R≥0 satisfying
•

•

dW
(x, δ x) ≤ δ y⊤ δ u,
dt

(9)

for all x, δ x, u, δ u. Furthermore, system (1) is called differentially lossless if (9) holds with equality.
If additionally, the differential storage function is required
to be a differential Lyapunov function, then differential
passivity implies contraction when the input is u = 0.
Lemma 1: Consider system Σu in (1). Suppose there exists
a differential transformation δ x̃ = Θ(x,t)δ x such that the
variational dynamics δ Σu in (3) takes the form

δ x̃˙ = [Ξ(x̃,t) − ϒ(x̃,t)] Π(x̃,t)δ x̃ + Ψ(x̃,t)δ u,
(10)
δ ỹ = Ψ(t)⊤ Π(x̃,t)δ x̃,
where Π(x̃,t) defines a Riemannian metric, Ξ(x̃,t) =
−Ξ⊤ (x̃,t), ϒ(x̃,t) = ϒ⊤ (x̃,t) and δ y the variational output.
If the following inequality holds


δ x̃⊤ Π̇(x̃,t) − 2Π(x̃,t)ϒ(x̃,t)Π(x̃,t) δ x̃ ≤ −α (W ) (11)
with α of class K . Then, Σu is differentially passive from
δ u to δ ỹ with respect to the differential storage function

1
(12)
W (x̃, δ x̃) = δ x̃⊤ Π(x̃,t)δ x̃.
2
2) Contracting virtual systems: A generalization of contraction was introduced in [23] to study the convergence
between solutions of two or more systems. This concept is
based on the contraction behavior of a virtual system.
Definition 6 (Virtual system): Consider systems Σ and Σu ,
given by (2) and (1), respectively. Suppose that Cv ⊆ X and
Cx ⊆ X are connected and forward invariant sets. A virtual
system associated to Σ is defined as the system

ẋv = Φv (xv , x,t),
Σv :
(13)
yv = hv (xv , x,t),
in the state xv ∈ Cv and parametrized by x ∈ Cx , where Φ :
Cv × Cx × R≥0 → T X and hv : Cv × Cx × R≥0 → T X satisfy
the condition
Φv (x, x,t) = F(x,t) and hv (x, x,t) = h(x,t),

(14)

for all t ≥ t0 . Similarly, a virtual control system for Σu is
defined as the control system

ẋv = Γ(xv , x, u,t),
(15)
Σuv :
yv = hv (xv , x,t),
∀t ≥ t0 ,

in the state xv ∈ X and parametrized by x ∈ X , the output
yv ∈ Y , where hv : Cv × Cx × R≥0 → Y and Γ : Cv × Cx ×
R≥0 → T X satisfy
Γ(x, x, u,t) = f (x,t) + G(x,t)u,
(16)
hv (x, x,t) = h(x,t),
∀u, ∀t ≥ t0 .
Theorem 2 (Virtual contraction [23], [6]): Consider Σ
and Σv in (2) and (13), respectively. Let Cv ⊆ X and
Cx ⊆ X be two connected and forward invariant sets.
Suppose that Σv is uniformly contracting with respect to
xv . Then, for any x0 ∈ Cx and xv0 ∈ Cv , each solution to Σv
asymptotically converges to the solution of Σ.
If Theorem 2 holds, then the actual system Σ is said to be
virtually contracting2. In case of the virtual control system
Σuv is differentially passive, then the actual control system
Σu is said to be virtually differentially passive.
3) Virtual differential passivity based control (v-dPBC):
The design method3 is divided in three main steps:
• Design the virtual system control (15) for system (1).
• Design the feedback u = ζ (xv , x,t)+ ω for (15) such that
the closed-loop virtual system is differentially passive
for the input-output pair (δ yv , δ ω ) and has a desired
trajectory xd (t) as steady-state solution.
• Define the controller for system (1) as u = η (x, x,t).
4) Trajectory tracking control via v-dPBC: Above method
can be directly applied to solve the trajectory tracking
problem, which for system (1) is stated as follows:
Tracking problem: Given xd (t), design a control law u(x,t)
for system (1) such that x(t) → xd (t) as t → ∞, uniformly.
Solution: in the second step of v-dPBC split the control as

η (xv , x,t) := u f f (xv , x,t) + u f b(xv , x,t)

(17)

such that
• The feedforward-like term u f f ensures that the closedloop virtual system has the desired trajectory xd (t) as
particular solution.
• The feedback action u f b commands the closed-loop
system to be differentially passive in a connected and
forward complete set C ⊆ X .
B. Mechanical port-Hamiltonian and virtual systems
Previous ideas will be applied to mechanical pH systems.
Definition 7 ([22]): A port-Hamiltonian system with N
dimensional state space X , input and output spaces U =
Y ⊂ Rm and Hamiltonian function H : X → R, is given by

∂H
ẋ = [JH (x) − R(x)]
(x) + G(x)u
∂x
∂H
(x),
y = G⊤ (x)
∂x

In the specific case of a standard mechanical system with
generalized coordinates q on the configuration space Q of
dimension n and velocity q̇ ∈ Tq Q, the Hamiltonian function
is given by the total energy
H(x) =

1 ⊤ −1
p M (q)p + P(q),
2

(19)

where x = (q, p) ∈ T ∗ Q := X is the state, P(q) is the
potential energy, p := M(q)q̇ is the momentum and the inertia
matrix M(q) is symmetric and positive definitive. Then, the
pH system (18) takes the form
# 

  
"∂H
(q,
p)
0
q̇
0
I
∂q
+
u,
=
B(q)
ṗ
−I −D(q) ∂∂Hp (q, p)
(20)
∂H
⊤
y = B (q)
(q, p),
∂p
with matrices

0
JH (x) =
−I



I
0
; R(x) =
0
0


 
0
0
; G(x) =
, (21)
D(q)
B

where D(q) = D⊤ (q) ≥ 0 is the damping matrix and I and 0
are the n × n identity, respectively, zero matrices. The input
force matrix B(q) has rank m ≤ n.
III. M ARINE C RAFT ’ S

PORT-H AMILTONIAN MODELING

In this part we adopt the modeling framework in reference
[8] and the notation of SNAME (1950) for marine vessels.
From a guidance, navigation and control point of view, in the
modeling of marine craft, four different coordinate frames
are considered: the Earth Centered inertial (ECI) frame {i},
whose origin Oi is located at the center of mass of the
Earth; the Earth-centered-Earth-fixed (ECEF) frame {e} that
rotates with the Earth; the North-East-Down (NED) frame
{n} with origin On defined relative to the Earth’s reference
ellipsoid (WGS84); and the body frame {b} which is a
moving coordinate frame that is fixed to the craft4 . In this
work we take the following modeling assumptions:
Assumption 1 (Flat navigation): The operating radius of
a marine craft is limited. We assume {n} to be inertial.
Assumption 2 (Maneuvering theory): The hydrodynamic
coefficients are frequency independent (no wave excitation).
Under above assumptions, the equation of motion in bodyfixed coordinates are [8]:

η̇ = J(η )ν ,
M ν̇ + C(ν )ν + D(ν )ν + g(η ) = τ

(22)

where G(x) is a N × m input matrix, and JH (x), R(x) are the
interconnection and dissipation N × N matrices which satisfy
JH (x) = −JH⊤ (x) and R(x) = R⊤ (x) ≥ 0.

where η = [x, y, z, φ , θ , ψ ]⊤ ∈ Q := R3 × S3 describes the
craft’s position and orientation; ν = [ν1⊤ , ν2⊤ ]⊤ is the (quasi)velocity in {b}, with ν1 [u, v, w]⊤ (surge, sway, heave) and
ν2 = [p, q, r]⊤ (roll, pith, yaw); and τ are the force and torque
inputs. The matrix function J(η ) is a well defined transformation if θ 6= ±π /2, due to the Euler angles representation

2 The concept was originally called partial contraction in [23]. However,
to avoid confusion with future research we use the adjective virtual.
3 Virtual systems for control design were already considered in [11], [13].

4 For a marine craft, the origin O is usually chosen to coincide with a
b
point midship CO in the water line; while the body-frame axes are chosen
to coincide with the principal axes of inertia [8].

(18)

[8]. The inertia matrix M = M ⊤ > 0 is given by


mI
−mS× (rgb )
M :=
mS× (rgb )
Ib

(23)

where m is the total mass due to the craft’s mass and fluid
added mass, Ib the moment of inertia in {b}, rgb the constant
vector between Ob and the center of gravity (CG) in {b}coordinates, and the matrix S× (·) is defined as


0
−a3 a2
S× (a) =  a3
0
−a1  .
(24)
−a2 a1
0

According to Kirchhoff’s equations of motion, the Corioliscentripetal matrix C(ν ) is any matrix satisfying
#
"
S× (ν2 ) ∂∂νT (ν )
1
,
(25)
C(ν )ν =
S× (ν2 ) ∂∂νT (ν ) + S× (ν1 ) ∂∂νT (ν )
2

1

where T ∗ (ν ) = 21 ν ⊤ M ν is the kinetic (co-)energy; D(ν ) =
D⊤ (ν ) > 0 is the total hydrodynamic damping matrix; and
g(η ) is the vector of hydrostatic forces and torques due to
gravity and buoyancy.
The force Fgrb (ν ) = C(ν )ν in (25) is workless for every ν .
Following [1], there exists a skew-symmetric matrix SLb (ν )
such that Fgrb (ν ) = SLb (ν )ν . This was also showed in [8] for
the specific case of system (22).
A. A note on marine craft’s dynamics in the inertial frame
The equations of motion (22) in the body-frame {b} can
be expressed in the inertial frame {n} by performing the
kinematic transformation η̇ = J(η )ν as follows [7, p.48]:
Mη (η )η̈ + Cη (η , η̇ )η̇ + Dη (η , η̇ )η̇ + gη (η ) = τη

(26)

where
Mη (η ) = J −⊤ (η )MJ −1 (η ),


˙ η ) J −1 ,
Cη (η , η̇ ) = J −⊤ C(J −1 η̇ ) − MJ −1 (η )J(

Dη (η , η̇ ) = J −⊤ (η )D(J −1 η̇ )J −1 (η ),

Fgr (η ,η̇ )

Thus, the force Fgr (η , η̇ ) is workless which implies that
there exists a skew-symmetric matrix SηL (η , η̇ ) such that
Fgr (η , η̇ ) = SηL (η , η̇ )η̇ . Thus, (29) takes the form


1
L
Cη (η , η̇ )η̇ = Ṁη (η ) + Sη (η , η̇ ) η̇ .
(31)
2
With this form, it is straightforward to verify that


η̇ ⊤ Ṁη (η ) − 2Cη (η , η̇ ) η̇ = 0,

for all η̇ and any Cη (η , η̇ ). In case the matrix Cη (η , η̇ ) is
expressed in terms of the Christoffel symbols of Mη (η ), the
skew-symmetric matrix SηL (η , η̇ ) is given as


∂ Mη i j
1 n ∂ Mη ki
L
Sη k j (q, q̇) = ∑
(q) −
(q) q̇i .
(32)
2 i=1 ∂ q j
∂ qk
From above observations and Cη (η , η̇ ) in (27), motivates
another choice of SηL (η , η̇ ) as
i
1h
SηL = J −⊤C(J −1 η̇ )J −1 + J −⊤ M J˙−1 − (J −⊤ M J˙−1 )⊤ .
2
Remark 1: In [7, p.54], there is not a clear relation between the Coriolis-centripetal matrix obtained with the EulerLagrange equations and the one in (27). However, due to
identity (31), this relation is made clear.
B. Craft’s pH model and virtual system in body-frame
In order to get a pH model of (22), in [3] and more recently
in [4], the next assumption is made:
Assumption 3: There exists P : Q → R satisfying

(27)

gη (η ) = J −⊤ (η )g(η ),

τη = J −⊤ (η )τ .
Alternatively, the Lagrange equations can be used to derive
the model (26) since in {n} the generalized position vector
η and its corresponding generalized velocity η̇ can be used
to express the kinetic (co-)energy as
1
Tη∗ (η , η̇ ) = η̇ ⊤ Mη (η )η̇ ,
2

which resembles the definition of the Coriolis-centripetal
matrix in the standard Euler-Lagrange setting in [14]. From
(29) is is easy to see that



1 ⊤
∂
⊤ 1
= 0.
(30)
η̇
η̇ Mη (η )η̇
Ṁη (η )η̇ −
2
∂η 2
|
{z
}

(28)

∂P
(η ) = G(η ).
(33)
∂η
Under Assumption 3, the marine craft dynamics (22) can be
written in port-Hamiltonian form as follows [4]:
#  
  
" ∂H
b)
(
η
,
p
0
J(η )
η̇
0
∂η
+
=
τ , (34)
In
ṗb
−J ⊤ (η ) −J2 (pb ) ∂∂ ṗHb (η , pb )
J ⊤ (η )

where the Hamiltonian function is
1
H(η , ṗb ) = pb⊤ M −1 pb + P(η ),
2

(35)

the quasi momentum is defined as5
Tη∗

and hence the Lagrangian function L(η , η̇ ) =
− P(η )
is well defined. For the dissipative hydrodynamic forces a
Rayleigh function FR (η , η̇ ) = 21 η̇ ⊤ Dη (η , η̇ )η̇ is considered.
With the Lagrangian approach, the Coriolis-centripetal matrix is any matrix Cη (η , η̇ ) satisfying


∂
1 ⊤
Cη (η , η̇ )η̇ = Ṁη (η )η̇ −
η̇ Mη (η )η̇ .
(29)
∂η 2

pb = M ν ,

(36)

and J2 (pb ) = C(M −1 pb ) + D(M −1 pb ). It is easy to see
that (34) is passive with (35) as storage function. Define
E b (η , pb ) := C(M −1 pb ) for future purposes.
5 Since pb is not the true momentum of η and ν are velocities in {b}
(quasi-velocities), for details see [10, p. 193] and [8].

C. Craft’s pH model and virtual system in inertial-frame
Also in [4], under Assumption 3, and pH model
in inertial coordinates was developed by translating the
(quasi)momentum vector pb in {b} to the frame {n} as
p = J −⊤ (η )pb ⇐⇒ p = Mη (η , η̇ )η̇ .
Then, the dynamics (36) in coordinates (η , p) is [4]:
# 

  
 " ∂ Hη
0
η̇
0
I
∂ η (η , p)
+ −⊤ τ ,
=
ṗ
−I −L(η , p) ∂ Hη (η , p)
J

(37)

(38)

∂p

where the Hamiltonian function is
1
Hη (η , p) = p⊤ Mη−1 (η )p + P(η ),
(39)
2
and the matrix
 −⊤
⊤
∂J
∂ J −⊤ ⊤
⊤
J p −
J p+J −⊤ J2 (M −1 J ⊤ p)J −1 .
L(η , p) =
∂η
∂η
(40)
Notice that (38) is a port-Hamiltonian system provided that it
satisfies Definition 7. However, this system is not a standard
mechanical pH system like (20), since its interconnection
matrix can not be written as the canonical one in (21).
Nevertheless, system (38) is still mechanical since its interconnection matrix defines an almost-Poisson structure6 [1],
that is, the energy conservation is satisfied. In the following
proposition an alternative form of (38) is presented.
Proposition 1: The pH system (38) takes the form
# 
" ∂P
  

(
η
)
0
I
0
η̇
∂
η
=
+ −⊤ τ ,
−I −(Eη (η , p) + DηH (η , p)) Mη−1 p
ṗ
J
(41)
where
1
E=
Ṁη (η ),
2 "
#
⊤
 −⊤
∂J
∂ J −⊤ ⊤
1
H
−⊤
−1
⊤
Sη = J CJ +
J p −
J p , (42)
2
∂η
∂η
SηH (η , p) −

DηH = Dη (η , Mη−1 (η )p).
IV. T RAJECTORY T RACKING C ONTROL D ESIGN
A. Control design in the body-fixed frame

1) Virtual control system design: The structure of (34)
motivates the definition of a virtual system for it, in the state
(ηv , pbv ) and parametrized by the trajectory (η , pb ), as
#  
  
 " ∂ Hv
b)
(
η
,
p
v
0
J(η )
η̇v
0
v
∂ ηv
=
+
τ , (43)
In
−J ⊤ (η ) −J2 (pb ) ∂ Hbv (ηv , pbv )
ṗbv
∂ pv

with

1 b⊤ −1 b
p M pv + Pv (ηv )
(44)
2 v
where Pv (ηv ) also fulfills Assumption 3 and Pv (η ) = P(η ).
Remarkably, (43) is also a pH system and passive with
b
(44) as storage function and supply rate y⊤
bη τη , where yη =
−1 b
b
M pv , uniformly in (η (t), p (t), for all t > t0 .
Hv (ηv , pbv ) =

6 The

associated Poisson bracket does not satisfy the Jacobi identity [1].

2) Differential passivity based control design: In this step
of the method v-dPBC, we will design τ = ζ b (xb , xbv ,t) + ω b
such that (43) is differentially passive in the closed-loop.
Proposition 2: Consider system (43) and a smooth trajectory xbd = (ηd , pbd ) in {b} with pbd = M −1 η̇d . Let us introduce
the following error coordinates
 b 

η̃v
ηv − ηdb
b
x̃v := b = b
,
(45)
σv
pv − pbr
where the auxiliary momentum reference pbr is given by
pbr (η̃vb ,t) := M(η̇db − φ b (η̃vb )),

(46)

φ b : Q → T Q is such that φ b (0) = 0; and Πηb v : Q ×
R≥0 → Rn×n is a positive definite Riemannian metric tensor
satisfying the inequality
Π̇bηv (η̃vb ,t) − Πηb v (η̃vb ,t)
−

∂φb b
(η̃ )
∂ η̃vb v

∂ φ b⊤ b b b
(η̃ )Π (η̃ ,t) ≤ −2βηbv (η̃vb ,t)Πbηv (η̃vb ,t),
∂ η̃vb v ηv v
(47)

with βηbv (η̃vb ,t) > 0, uniformly. Assume also that the i-th row
of Πηb v (η̃vb ,t) is a conservative vector field7 . Consider also
the composite control law given by

τ (xbv , xb ,t) := τ f f (xbv , xb ,t) + τ f b (xbv , xb ,t) + ω b ,
where

xb

=

(η , pb ),

τ f f = ṗbr +
τfb = −

=

(ηv , pbv )

Πbηv (ξ ,t)d ξ

(48)

and


∂ Pv  b
+ E (η , pb ) + D(M −1 pb ) M −1 pbr ,
∂ ηv

Z η̃ b
v
0

xbv

− Kd M

−1

(49)

σvb ,

with Kd > 0 and ω b be an external input. Then,
1) system (43) in closed-loop with (48) is differentially
passive from δ ω b to δ yσb v = M −1 δ σvb with respect to
the differential storage function


1 b⊤ Πηvb
0
b
b
Wxb (x̃v , δ x̃v ) = δ x̃v
δ x̃bv .
(50)
0
M −1
2
2) the closed-loop variational dynamics preserves the
structure of (10), with
Πb = diag{Πbηv (η̃vb ,t), M −1 }
 b

∂ φ b−1
−1 b
ϒb = diag
Π , D(M p ) + Kd ,
(51)
∂ η̃vb ηv

 

0
I
0
b
Ξb =
b (pb ) ; Ψ = I .
−I −SH
Remark 2: The timed-IDA-PBC method proposed in [26]
uses the contraction property of a target pH system for
solving the tracking problem. In particular, one of the main
assumptions is that the interconnection and dissipation matrices are constant. In this regards, our proposed v-dPBC
approach can be used to relax this assumption for the marine
craft case with the pH system (34).
7 This ensures that the integral in (49) is well defined and independent of
the path connecting 0 and q̃v .

3) Actual system’s controller: Here we show that the
controller which is designed in the previous item can be used
as a trajectory tracking controller for the actual Hamiltonian
system (34). This is stated in the following corollary.
Corollary 1: Consider the controller (48). Then, all solutions of system (34) in closed-loop with the control law

τ (xb , xb ,t) = τ f f (xb , xb ,t) + τ f b (xb , xb ,t)
converge exponentially to the trajectory xbd (t) with rate

β b = min{βηbv , λmin {D + Kd }λmin {M −1 }},

(52)

where λmin (·) is the minimum eigenvalue of its argument.
B. Control design in the inertial frame
The control design procedure in the inertial frame is almost
identical to that in the body-fixed frame. Thus, due to space
limitation we only state the results without proof.
1) Virtual control system design: With the alternative
form (41) in Proposition 1, we define a virtual system
associated with the pH system (38), in the state (ηv , pv ) and
parametrized by (η , p), as the time-varying system
#  
  
 " ∂ Pv
)
(
η
0
I
η̇v
0
v
∂ ηv
τ , (53)
=
+
−I −(Eη + DηH ) Mη−1 pv
I η
ṗv
This system also inherits the passivity property of the actual
one in (41), with storage function
Hηv (ηv , pv ,t) =

1 ⊤ −1
p M (η )pv + Pv (ηv ),
2 v η

(54)

and define the auxiliary momentum reference as
(56)

where φ : Q → T Q is such that φ (0) = 0; and Πηv : Q ×
R≥0 → Rn×n is a positive definite Riemannian metric tensor
satisfying the inequality
Π̇ηv (η̃v ,t) − Πηv (η̃v ,t)
−

∂φ
(η̃v )
∂ η̃v

∂φ⊤
(η̃v )Πηv (η̃v ,t) ≤ −2βηv (η̃v ,t)Πηv (η̃v ,t),
∂ η̃v

(57)

with βηv (η̃v ,t) > 0, uniformly. Assume also that the i-th row
of Πηv (η̃v ,t) is a conservative vector field. Consider also the
composite control law given by

τ (xv , x,t) := τ f f (xv , x,t) + τ f b (xv , x,t) + ω ,

τη f f = ṗr +
τη f b = −


∂ Pv 
+ Eη (η , p) + DηH (η , p) Mη−1 (η )pr ,
∂ ηv

Z η̃v
0

Πηv (ξ ,t)d ξ

(59)

− Kd Mη−1 (η )σv ,

where Kd > 0 and ω is an external input. Then,
1) system (53) in closed-loop with (58) is differentially
passive from δ ω to δ yσv = Mη−1 (η )δ σv with respect
to the differential storage function


0
1 ⊤ Πηvb
Wx (x̃v , δ x̃v ) = δ x̃v
δ x̃v .
(60)
0
Mη−1 (η )
2
2) the closed-loop variational dynamics preserves the
structure of (10), with
Π = diag{Πηv (η̃v ,t), Mη−1 (η )}


∂ φ −1 H
Πηv , Dη (η , p) + Kd ,
ϒ = diag
(61)
∂ η̃v

 

0
I
0
; Ψ=
.
Ξ=
−I −SηH (η , p)
I
3) Actual system’s controller: Here we show that the
controller that was designed previously can be used as
a trajectoy tracking controller for the actual Hamiltonian
system (38). This is stated as follows:
Corollary 2: Consider the controller (58). Then, all solutions of system (34) in closed-loop with the control law

τη (x, x,t) = τη f f (x, x,t) + τη f b (x, x,t)
converge exponentially to the trajectory xd (t) with rate

for any trajectory (η (t), p(t)) and t > t0 and supply rate
yη⊤ τη , where the output is given by yη = Mη−1 (η )pv .
2) Differential passivity based control design:
Proposition 3: Consider system (53) and a smooth trajectory xd = (ηd , pd ) ∈ T ∗ Q. Let us introduce the following
error coordinates

  
η̃
η − ηd
,
(55)
x̃v := v = v
pv − pr
σv
pr (η̃v ,t) := M(η̇d − φ (η̃v )),

where x = (η , p), xv = (ηv , pv ) and

(58)

β = min{βηv , λmin {Dη + Kd }λmin {Mη−1 }}.

(62)

V. E XAMPLE : O PEN - FRAME UUV
We consider the example in [4] which is an open frame
underwater vehicle with 140 kg of dry mass . The vehicle has
four thrusters in an x-type configuration such that the system
in fully-actuated in the degrees of freedom of interest, i.e.,
surge, sway and yaw. The corresponding inertia, Coriolis and
damping matrices in the body frame, respectively, are


290 0
0
M =  0 404 50  ,
0
50 132


0
0
−404v − 50r
,
0
0
290u
C=
404v + 50r −290u
0


95 + 268|v|
0
0
0
613 + 164|u| 0  .
D=
0
0
105

Due to space limitations, we only present the performance of
controller (48) in body frame, with φ b (η̃vb ) = Λη̃vb where Λ =
diag{0.6, 0.8, 0.2}, Πηb v = Λ and Kd = diag{300, 100, 200}.
The time performance of system configuration η and the
desired reference ηd is shown in Figure 1. After a short
transient, system’s position tracks asymptotically to ηd .

x position [m]

15
Reference
Position

10
5
0
0

10

20

30

40

50

60

70

40

50

60

70

40

50

60

70

y position [m]

Time [s]
1
0
-1
-2
0

10

20

30

angle [deg]

Time [s]
100
50
0
-50
0

10

20

30

Time [s]

Fig. 1.

Vehicle’s position vector η against ηd .

VI. C ONCLUSIONS

AND FUTURE RESEARCH

In this work we have applied the v-dPBC method to solve
the trajectory tracking problem in marine craft, where the pH
structure and its workless forces have been exploited in the
control design procedure. The exponential convergence to a
unique predefined steady-state trajectory is guaranteed by the
differential passivity property of a so-called virtual system.
We have developed two families of control schemes based
on body-fixed attitude and velocity measurements, one for
the pH model in {b} and another for the pH model {n}. The
structure of the pH models and associated virtual systems
is independent of the coordinate frame. Simulations confirm
the expected performance of the closed-loop system.
As future work, we will use of the differential passivity
property of the closed-loop system to design observers and
integral actions in a differential passivity preserving manner.
R EFERENCES
[1] Dong Eui Chang. Controlled Lagrangian and Hamiltonian systems.
PhD thesis, California Institute of Technology, 2002.
[2] Peter E. Crouch and Arjan van der Schaft. Variational and hamiltonian
control systems. Springer-Verlag, 1987.
[3] Alejandro Donaire and Tristan Perez. Dynamic positioning of marine
craft using a port-Hamiltonian framework. Automatica, 48(5):851 –
856, 2012.
[4] Alejandro Donaire, Jose Guadalupe Romero, and Tristan Perez. Trajectory tracking passivity-based control for marine vehicles subject to
disturbances. Journal of the Franklin Institute, 354(5):2167 – 2182,
2017.
[5] Fulvio Forni and Rodolphe Sepulchre. A differential Lyapunov
framework for contraction analysis. IEEE Transactions on Automatic
Control, 2014.
[6] Fulvio Forni, Rodolphe Sepulchre, and Arjan van der Schaft. On
differential passivity of physical systems. In Decision and Control
(CDC), 2013 IEEE 52nd Annual Conference on, pages 6580–6585.
IEEE, 2013.
[7] Thor I Fossen. Guidance and control of ocean vehicles. John Wiley
& Sons Inc, 1994.
[8] Thor I Fossen. Handbook of marine craft hydrodynamics and motion
control. John Wiley & Sons, 2011.
[9] Thor I Fossen and Svein P Berge. Nonlinear vectorial backstepping design for global exponential tracking of marine vessels in the presence
of actuator dynamics. In Decision and Control, 1997., Proceedings
of the 36th IEEE Conference on, volume 5, pages 4237–4242. IEEE,
1997.

[10] Donald T. Greenwood. Advanced Dynamics. Cambridge University
Press, 2003.
[11] Jerome Jouffroy and Thor I. Fossen. A tutorial on incremental stability
analysis using contraction theory. Modeling, Identification and control,
31(3):93–106, 2010.
[12] Winfried Lohmiller and Jean-Jacques E Slotine. On contraction
analysis for non-linear systems. Automatica, 1998.
[13] Ian R Manchester, Justin Z Tang, and Jean-Jacques E Slotine. Unifying
classical and optimization-based methods for robot tracking control
with control contraction metrics. In International Symposium on
Robotics Research (ISRR), pages 1–16, 2015.
[14] Romeo Ortega, Julio Antonio Lorı́a Perez, Per Johan Nicklasson,
and Hebertt Sira-Ramirez. Passivity-based control of Euler-Lagrange
systems. Springer Science & Business Media, 1998.
[15] Alexey Pavlov and Nathan van de Wouw. Convergent systems:
nonlinear simplicity. In Nonlinear Systems, pages 51–77. Springer,
2017.
[16] Rodolfo Reyes-Báez, Arjan van der Schaft, and Bayu Jayawardhana. Tracking control of fully-actuated port-hamiltonian mechanical systems via sliding manifolds and contraction analysis. IFACPapersOnLine, 50(1):8256 – 8261, 2017. 20th IFAC World Congress.
[17] Rodolfo Reyes-Báez, Arjan van der Schaft, and Bayu Jayawardhana.
Virtual differential passivity based control for tracking of flexiblejoints robots. In Accepted 6th IFAC Workshop on Lagrangian and
Hamiltonian Methods for Nonlinear Control - LHMNC, 2018.
[18] Eduardo D Sontag. Contractive systems with inputs. In Perspectives in
Mathematical System Theory, Control, and Signal Processing, pages
217–228. Springer, 2010.
[19] Asgeir J. Sorensen and Olav Egeland Asgeir. Design of ride control
system for surface effect ships using dissipative control. Automatica,
31(2):183 – 199, 1995.
[20] Arjan van der Schaft. On differential passivity. IFAC Proceedings
Volumes, 46(23):21–25, 2013.
[21] Arjan van der Schaft. L2-Gain and Passivity Techniques in Nonlinear
Control. Springer International Publishing, 2017.
[22] Arjan. van der Schaft and Bernhard. Maschke. The Hamiltonian
formulation of energy conserving physical systems with external ports.
Archiv fr Elektronik und bertragungstechnik, 49, 1995.
[23] Wei Wang and Jean-Jacques E Slotine. On partial contraction analysis
for coupled nonlinear oscillators. Biological cybernetics, 92(1), 2005.
[24] Jan C. Willems. Dissipative dynamical systems, part i: General theory.
Arch. Rational Mech. Anal., 45, 1972.
[25] Craig A. Woolsey and Naomi E. Leonard. Stabilizing underwater
vehicle motion using internal rotors. Automatica, 38(12), 2002.
[26] Abolfazl Yaghmaei and Mohammad Javad Yazdanpanah. Trajectory
tracking for a class of contractive port-Hamiltonian systems. Automatica, 83:331 – 336, 2017.

