Hindawi Publishing Corporation Modelling and Simulation in Engineering Volume 2013, Article ID 839046,13 pages http://dx.doi.org/10.1155/2013/839046

Research Article

Investigation into the Dynamics and Control of an Underwater Vehicle-Manipulator System

Mohan Santhakumar

Centre for Robotics and Control, Mechanical Engineering, Indian Institute of Technology Indore, Madhya Pradesh 452017, India Correspondence should be addressed to Mohan Santhakumar; santha_radha@yahoo.co.in Received 12 July 2013; Accepted 19 September 2013 Academic Editor: Ahmed Rachid

Copyright © 2013 Mohan Santhakumar. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

This study addresses the detailed modeling and simulation of the dynamic coupling between an underwater vehicle and manipulator system. The dynamic coupling effects due to damping, restoring, and inertial effects of an underwater manipulator mounted on an autonomous underwater vehicle (AUV) are analyzed by considering the actuator and sensor characteristics. A model reference control (MRC) scheme is proposed for the underwater vehicle-manipulator system (UVMS). The effectiveness of the proposed control scheme is demonstrated using numerical simulations along with comparative study between conventional proportionalintegral-derivative (PID) control. The robustness of the proposed control scheme is also illustrated in the presence of external disturbances and parameter uncertainties.

1. Introduction

The underwater manipulator has turned into a critical part/tool of underwater vehicles for performing interactive tasks such as opening and closing of valves, cutting, drilling, sampling, and laying in the fields of scientific research and ocean systems engineering. Due to unstructured properties of interactive work, a good understanding of the dynamics of a robotic manipulator mounted on a moving underwater vehicle is required for autonomous manipulation tasks [1,2].

The increasing in demand for more efficient, precise, and accurate underwater autonomous manipulation has induced many researches in this field, which includes the dynamic model and effective simulation of an underwater manipulator mounted on an underwater vehicle. The first attempt towards modeling of an underwater vehicle-manipulator system (UVMS) started with the development of a dynamic simulation algorithm using the Newton-Euler formulation scheme [3,4]. Similarly, using the Kane's method, a simplified dynamic model of UVMS was developed and verified using numerical simulations [5]. A coordinated control scheme for the UVMS using a discrete-time approximation dynamic model was developed to compensate for the tracking errors of the manipulator during vehicle motion [6]. The UVMS

dynamic model was formulated using the quasi-Lagrange method [4, 7]. A nonlinear model-based control scheme that controlled the vehicle and manipulator simultaneously was developed and investigated [8]. In addition to these studies, some of the researches were focused on estimating hydrodynamic parameters of these systems [8], the reduction of the interaction effects (dynamic coupling) between the manipulator and the vehicle [9], and the manipulability and workspace analysis of the underwater manipulator on remotely operated vehicle (ROV) [10]. Also, there have been many studies on manipulator control for enhancing efficiency of underwater manipulation, such as the force feedback control of manipulators mounted on ROVs [11], motion planning, and control of UVMS [7], computer-based control, and real-time motion compensation of UVMS [12]. The workspace-control system for the teleoperated ROV was proposed by combining the ROV master-slave systems and verified through experiments [13]. Despite of these significant researches, most intervention tasks conducted in the field still depend on operator's skills. Therefore, much demand and developments are needed in autonomous manipulation, which gives much attention to and interest in this research field. Although there have been some research attempts to overcome the parameter uncertainties on underwater robots,

very few attempts considered the problem of uncertainties associated with time varying parameters on UVMS with manipulator motion causing dynamic coupling. In addition to the coupling effects, most of the real-time AUVs are underactuated in nature (i.e., the vehicle has fewer number of control inputs than the total number of independent states which makes the control scheme complex) which complicates the problem.

Therefore, by considering the above-mentioned issues, this paper presents the closed-form dynamic equations of an UVMS, and the interaction effects between the manipulator and the vehicle are investigated numerically based on prototype vehicle-manipulator parameters. This paper also proposes a model reference control scheme for the UVMS. This scheme enables overcoming the difficulty due to parameter uncertainties, external variations (e.g., buoyancy and payload variations), and disturbances (e.g., underwater current). In this study, the actuator and sensor characteristics such as time constant, efficiency, saturation limits, update rate, and sensor noises are considered for numerical simulations. In the vehicle dynamic modeling, off diagonal elements of the system matrices are considered as well. The effectiveness of the proposed control scheme is confirmed with specified UVMS tasks.

The remainder of this paper is organized as follows. The dynamic modeling of a general UVMS is derived in Section 2. In Section 3, a nonlinear controller for the UVMS based on the model reference control scheme is discussed and detailed performance analysis of the UVMS with different operating conditions is presented in Section 4. Finally, Section 5 holds the conclusions.

2. Mathematical Modeling of UVMS

2.1. Dynamic Model of the Underwater Vehicle. The dynamic model of an underwater vehicle is developed through the Newton-Euler formulation using laws of conservation of linear and angular momentum. The equations of motion of such vehicles are highly nonlinear [4] mainly due to hydrodynamic forces which act on the vehicle. Generally, the vehicle model can be written with respect to either a body-fixed or an earth-fixed frame of reference (refer to Figure 1).

The equations of motion of an underwater vehicle having six degrees of freedom with respect to a body-fixed frame of reference can be written as [4]

Mv + C (v) v + D (v) v + g (rç) = Tv

M = MRB + MA, C (]) = CRB (]) + CA (v), D (v) = Dl + D0 |v|.

MRB and CRB(v) are the rigid body mass matrix and the Coriolis and centripetal matrix, respectively. MA and CA(v) are the added mass matrix and the added Coriolis and centripetal matrix, respectively. DL and DQ|v| are the linear

Sway (y)^Pitch(0W,

Roll (0) Surge(x)

Inertial frame (fixed) Yaw

Sway axis^ Y, v, and v

-, — Yaw axis v____y N r, and f

Manipulator base frame

Heave axis Z, w, and w

Manipulator

Figure 1: Coordinate frame arrangement of an underwater robot.

Manipulator end-effector frame

and quadratic drag matrices, respectively. g(^) is the resultant vector of gravity and buoyancy. rv = [X Y Z K M N] is the resultant input vector of thruster, control plane forces, and moments. v = [w v w _p ^ r]T is the vector of linear and angular velocities in the vehicle coordinate frame. ^ = [x y z 0 0 y] is the vector of absolute positions and Euler angles (roll, pitch, and yaw).

The relationship between linear and angular velocities in the vehicle frame and those in the absolute frame (refer to Figure 1) is given by

n = J (rç) v,

where J(^) is the kinematic transformation matrix and this transformation is undefined for 0 = ±90°. However, most of the underwater vehicles are designed to operate at pitch angles well below ±90°, and hence this limitation has no major significance here.

2.2. Kinematic Model of the Underwater Manipulator. The mathematical model of the underwater manipulator kinematics is derived in this section.

2.2.1. Forward Kinematics of the Underwater Manipulator. The mathematical relations of the end-effector position/tool center point (TCP) or manipulator tip position with the known joint angles are derived here. The mathematical (kinematic) descriptions of the underwater manipulator are developed based on the Denavit-Hartenberg (D-H) parameter notation [14]. The establishment of the link coordinate system as shown in Figure 2 yields the D-H parameters

Figure 2: Establishing link coordinate systems of the manipulator.

shown in Table 1. Based on the underwater link parameters in Table 1, the homogeneous transformation matrix [14] which is derived, that specifies the location of the end effector or TCP with respect to the base coordinate system, is expressed as

t0 _ T4 ~

_ rpOnpl np2np3

cos dk - sin dk 0 ak-1

sin dk cos ak_x cos dk cos a^ -sin a^ -sin a^ dk sin dk sin ak_x cos dk sin a^ cos a^ cos a^ dk 0 0 0 1

The matrix R^ and the vector P^ = [px py pz]T are the rotational matrix and the position vector from the base coordinates to the end effector, respectively. From the above homogeneous transformation matrix, we can obtain the end effector's position for feedback control and the elements for solving the Jacobian matrix. Based on the experimental underwater manipulator parameters (refer to Table 1), the forward kinematic solutions are obtained as follows:

px = cos d1 (L1 + L2 cos d2 + L3 cos (d2 + d3)), py = sindx (L1 + L2 cos d2 + L3 cos (d2 + d3)), (5) Pz = L 2 sin d2 + L 3 sin (d2 + d3).

2.2.2. Inverse Kinematics of the Underwater Manipulator. In the workspace-control system, each joint of the underwater manipulator is controlled by the joint angle command calculated from the differential inverse kinematic solutions based

Table 1: D-H parameters of the 3-DOF underwater manipulator.

Joint axis Link offset Link length Joint distance Joint angle

№) («k-l) (ak-l) (dk) (&k)

1 0° 0 0

2 90° L l 0 Ö2

3 0° L 2 0 83

4 0° L 3 0 e4 = 0°

on the known Cartesian coordinates. The closed-form inverse kinematic solutions of the 3-DOF underwater manipulator are described as

di = arctan 2 (py,px),

d2 = arctan 2 (ab — be, ac + bd),

d3 = arctan 2 (sin d3, cos d3),

cos d3 =

a +b — L2 - L3 2.L 2L 3

sin d3 = — cos2d Px

cos dl c = L3 cos d3 + L2,

— L i, b = pz

= L 3 sin d3

2.3. Dynamic Model of the Underwater Manipulator. The dynamic model of an underwater manipulator is developed through the recursive Newton-Euler algorithm. In this work, it is assumed that the underwater manipulator links are the buildup of cylindrical elements. The effects of the hydrody-namic forces on circular cylindrical elements are described in the section, which mainly consist of added mass effects, hydrodynamic drag forces and moments, and buoyancy effects [4]. The force and moment interactions between two adjacent links are as follows:

kr kr nk+l k+lr p 1

fk = fk+l = Rk fk+l + Fk — mkgk + bk + Pk>

kt _ kt _Rk+lk+lt , d vRk+lk+lf tk ~ tk+l - Rk \+l + ak/k+lx Rk f

+ dk/kc X Fk + Tk + dk/kc

X (—mk§k + Pk) + dk/kb X bk + nk

pk = FLk + FDk + FSk'

Fsk = Ds kk,

F Dk =

n = V X

k k dl Vk'

(MkkVk)

Fk = Mfc ( fcafc +kak x kdk/kc +kwk x (kwk x fcdfc/fcc)) ,

Tk = Jk k«k +k ^k x (lk k^k) >

k+1 nk k T •

^k+1 = Rk+1 ^k + z ik+1>

k k k T T

«k+1 = Rk+1 ( «k + ^k x z <ik) + z ik+1

k+1 nk k k+1 k+1 j vk+1 = Rk+1 vk + ^k+1 x d

■k/kc>

1 _ D' k k+1 k+1 j

ak+1 _ Rk+1 ak + «k+1 dk+1/k

+ k+1^k+1 x(k+1^k+1 xk+1

dk+1/k) ,

mk + ^k^k 0

0 mk + ^rk2Lk

^k2.Lk3 12

where fc denotes the corresponding joint axis (fc = 1,2,3), Rfc+ is the rotation matrix, ffc is the resultant force vector, tfc is the resultant moment vector, pfc is the linear and quadratic hydrodynamic friction forces, and Fsfc, FDfc, and FLfc are vectors of linear skin friction, quadratic drag, and quadratic lift effects, respectively. Dk is the linear skin friction matrix, Dk is the diagonal matrix which contains lift coefficients, D^ is the diagonal matrix which contains drag coefficients, gfc is the gravity force vector, bfc is the buoyancy force vector, nfc is the hydrodynamic moment vector, is the vector from the center ofbuoyancy of the link, dfc/fcc is the vector from the center of gravity of the link, dfc/fc+1 is the vector from joint fc to fc + 1, Ffc is the vector of total forces acting at the center of mass of link, Tfc is the vector of total moments acting at the center of mass of link, afc is the linear acceleration vector, afc is the angular acceleration vector, vk is the linear velocity vector, wk is the angular velocity vector, mk is the mass of the link, Mk is the mass and added mass matrix of the link (located at the center of mass), Ik is the moment of inertia and added moment of matrix of the link (located at the center of mass), and zT is the unit vector along the z-axis.

The joint torques of each link are represented as

TRk = z "tc • (12)

The recursive Newton-Euler dynamics algorithm for all links, symbolically, yields the equations of motion for the underwater manipulator. The result can be written as follows:

M (<?)q + (<?> 4)q + D (<?> 4)q + g^ (<?) = ^ (13)

where q is the vector of joint variables and q = [01 02 ]T, 01,02,03 are the joint angles of the corresponding underwater

manipulator links, MB(^)q is the vector of inertial forces and moments of the manipulator, 4)q is the vector of Cori-olis and centripetal effects of the manipulator, 4)q is the vector of damping effects of the manipulator, gB(^) is the restoring vector of the manipulator, and = [rB1 r0 is the vector of control inputs.

'Ä2 'Ä3

2.4. Dynamic Model of Vehicle-Manipulator System. The manipulator has an initial velocity equal to the velocity of the vehicle. This initial velocity should be accounted in the manipulator dynamics. Similarly, the weight and movement of the manipulator links will affect the vehicle dynamics (these effects are considered as disturbances) and vice versa. By considering the above issues, the vehicle and manipulator equations of motions can be written as follows:

Mv + C (v) v + D (v) v + g = Tv + a,

m_r (<?) q+(<?)v+cb <?) q+d <?) q (14)

+ g£ (<?) + Cv ^ v) v + Dv ^ v) v = ^

where is the vector of reaction forces and moments

between the vehicle and the manipulator, 4, v)v is the vector of Coriolis and centripetal effects due to coupling between the vehicle and the manipulator, and 4, v)v

is the vector of quadratic drag effects due to the interaction

between the vehicle and the manipulator. a = [o^ ais the vector which contains forces and moments disturbances due to weight and movement of the manipulator links. Consider

n -RB0f

af~ Ro r1>

°m = R0 0t1 - dv<

vehicle/manipulator '

where Rq and dvehicle/manipulator are the rotation matrix and position vector from the vehicle-fixed frame to the manipulator base frame, respectively. 0f1 and 0t1 are the vectors of force and moments of the base frame, respectively. These vectors are derived using (8), and these effects are function of the manipulator joint coordinates (i.e., q, q, and q) and the vehicle states. After evaluating the interaction forces and moments between the manipulator and the vehicle based on these vectors, the equations of motion of the vehicle can be written as

Mv + H1 (g) v + C (v) v + D (v) v + Cv (q, 4, v) v

+ Dv fo ^ v) v + g + H2 q + C1 fo q) q (16)

+ D1 fo 4) q + g1 (i) = ^

where H1(^)v and H2(^)q are the added inertia effects due to the manipulator, D1(^, 4)q is the damping effects due to the manipulator, C1 (q, 4)q is the Coriolis and centripetal effects due to the manipulator, and g1 is the restoring vector due to the manipulator on the vehicle, respectively.

Figure 3: Block diagram of model reference control.

transforms the nonlinear system dynamics into a linear system; it compensates for all the nonlinearities in the system by introducing nonlinear elements in the input side, thus making the controller design more flexible [15-17]. Unlike traditional control, it can be thought of as "instantaneous learning" of the vehicle dynamics. The individual control laws of the underwater vehicle and the manipulator are chosen such that the tracking errors are converging to zero. The tracking errors are defined as fj = t]d -1] and q = qd - q, where d denotes the desired (or reference) values. The equations of motion of the UVMS can be expressed in the form given below [15]:

Mvv + H2 (q) q + F1 (q, q, v) + G1 (?/, q) = rv,

(q) q + HT2{q)v + F2 (q, q, v) + G2 (q) = rR,

Figure 4: Schematic diagram of UVMS prototype model.

3. Model Reference Control

This section discusses the model reference control (MRC) design in terms of feedback linearization. This control scheme

where Mv = M + H^g), Fi(q, q, v), ¥2(q, q, v), G2(q), and Gj (?/, q) are the vectors of the Coriolis, centripetal and damping/frictional, and restoring effects of the vehicle and the manipulator, respectively.

The proposed control input vectors given by (18) will cancel out or compensates for the nonlinearities in the system as

TV = Mvuv + H2 (i) q + F1 (<j, 4,]) + G1 q), TR = mR (i) uR + hT (i)» + F2 (<i> <?> ]) + G2 (i) >

uv = JM 1 K - JM JM 1^)> U? = % + Kpv»f + Kdv»i + K;v j V

uR = ?d + Kr? + KdRq + KR j q

K^y, K)V, and Kdy are the proportional, integral, and derivative gain matrices of the vehicle controller, respectively, and KiB, and KdB are the proportional, integral, and derivative gain matrices of the manipulator controller, respectively. Block diagram representation of the proposed UVMS controller is presented in Figure 3.

The above-mentioned control vectors lead to exponential stable error dynamics of the vehicle and manipulator which are given as

V + KPvf + Kdv»i + Kv j fldt = q + KPRq + KdR? + KiR j q^i = 0>

which implies that tracking errors are converging to zero (i.e., jj ^ 0 and q ^ 0) and the UVMS follows the given desired trajectory [18].

However, the above-proposed control scheme assumed that there are no disturbances and no uncertainties associated with the system. If the system uncertainties and external disturbances are considered for the analysis, the system error dynamics become

V + KPvf + Kdvf + K,v j *ldt q + KPRq + KdRq + K ¡R j q^

■v ldv>

= MR ^ *dR>

where and are the disturbance vector (which combines the internal disturbances such as effect of parameter uncertainties and external disturbances, namely, underwater current, etc.) of the vehicle and manipulator controller, respectively.

The closed-loop characteristic equation or polynomial is given as

W (*) =

A cr (s) =

s2I + ^Kdv + Kpv +

S 1 + SKdR + KpR +

The control gain matrices are chosen as diagonal and positive definite matrices, such as

Kdv = diag (fcdvi)

= diag (Vi)>

Kv = diag (fcivi) > KdR = diag (fcdRi) >

= diag (fcpRi)> KiR = diag (fciRi)-

Therefore, the closed-loop characteristic polynomial becomes

-w = n

s2 + sfc

dvi + ^pvi +

AcR (s) = n (^2 + sfcdRi + V»

v >R> S

and the system error is asymptotically stable as long as the controller gain values are all positive. Therefore, as long as the disturbance vectors are bounded, the system tracking errors are converged to zero. In other words, the system follows the given desired trajectory. Moreover, the controller gain matrices have been chosen in such a way that

^min {Kpv} ^min {KpR}

^min {Kdv} >

^min {KdR

{KdR} >

Hence, jj = 0 and q = 0 for all t > 0 are its unique solution, and it can be observed that the system tracking errors are converging to zero asymptotically. The proposed controller analysis does not contain explicit treatment of the parametric uncertainties and external disturbance while taking temporal derivative along the closed-loop system trajectories, and it is left for further research and analysis.

4. Performance Analysis of the UVMS

4.1. Description of the Simulated System. We have accomplished widespread computer-based numerical simulations to explore the total performance of the proposed UVMS and the model reference (direct adaptive) control scheme. The UVMS used for this study consists of six degrees of freedom (DOF) vehicle and a 3-DOF spatial manipulator; the UVMS arrangement in conceptual design is presented in Figure 4. The vehicle is a cylindrical shape (torpedo fish shaped) cruising type with the length of 1.1 m and the diameter of 0.25 m. The mass of the vehicle is 39 kg. The vehicle has five thrusters in total, two propulsion thrusters (in the stern side), two vertical thrusters, and one lateral thruster. Therefore, surge, sway, and heave motions are controlled through these thrusters actuation directly, and, however, yaw and pitch motions are controlled by differential actuation of propulsion and vertical thrusters. Although roll motion is unactuated, it can be controlled itself due to restoring effects [19-21]. It is known that a necessary condition for a submersible body to

be stable is that the centre of gravity (CG) should lie below the centre of buoyancy (CB). For this, the vehicle is trimmed (using a float) to have the CB almost vertically above the CG and made to be nearly neutral buoyant. Here the roll motion has nonzero components of restoring moments that represent self-restoring torque for the roll direction. With nonzero restoring terms, it may be possible to find continuous state feedback laws to stabilize the system as a whole. In addition to this, without loss of generality, we can assume that the damping terms of nonactuated states are sufficiently larger than their inertia terms which means that the hydrodynamic restoring forces and torques are large enough to stabilize the nonactuated (roll) states (zero dynamics), which is a common property for AUVs [19]. This means that the underwater robot can be exponentially stabilized by the actuated state controls alone.

The manipulator links are cylindrical in shape, and the radii of links 1, 2, and 3 are 0.1m, 0.05 m, and 0.05 m, respectively. The lengths of links 1, 2, and 3 are 0.1m, 0.2 m, and 0.2 m, respectively. The link masses (along with oil conserved motors) are 0.39 kg, 1.57 kg, and 1.57 kg, respectively. Here, the links are considered as cylindrical shape because such shape provides uniform hydrodynamic reactions and is one of the primary candidates for possible link geometry for underwater manipulators. Although it is cylindrical, our mathematical framework does not depend on any particular shapes; it can be easily accommodated by any other shapes. Indeed, cylindrical underwater manipulators are available in the present market [22]. Hydrodynamic parameters of the UVMS are estimated using empirical relations based on strip theory. This method is verified using the available literature; therefore, these values are reliable and can be used for further developments. Some parameters like inertia, centre of gravity, and centre of buoyancy are calculated from the geometrical design of the UVMS. The total parameter list of the UVMS is given in Tables 2 and 3.

We have compared our results with those of traditional PID controller; the following control vectors were considered for the vehicle and the manipulator and are given by

rv = KDVtj + KPVlj + KJV i jj dt,

= kdrq + kprq + kK J q dt,

where KPV, KJV, KDV, KPR, KJR, and KDR are the proportional, integral, andderivativegainmatricesofthe vehicleand the manipulator, respectively.

4.2. Description of the Tasks. Three different tasks with four different cases have been considered for the simulations. The first task is that the vehicle is commanded to track a given 3D trajectory without and with the manipulator (at rest or its home position), and in this condition the vehicle accelerates for the initial 20 s and attains the vehicle forward speed of 1 m/s (~2 knots) and for the final 20 s the vehicle decelerates to zero speed. The particular desired 3D trajectory (refer to Figure 5) has been chosen for this performance analysis, because this trajectory consists of all four main motions such

Table 2: The parameter list of the UVMS.

Parameters Values

Mass of the vehicle (mV) 39 kg

Length of the vehicle (L V) 1.1m

Diameter of the vehicle (dV) 0.25 m

Moment of inertia of the vehicle

4 0.34 kgm2

h 3.11 kgm2

4 3.11 kgm2

Centre of gravity (CG) = (xG, yG, zG) (0, 0, 0) m

Centre of buoyancy (CB) = (xB, yB, zB) (0, 0, 0.015) m

Mass ofthe underwater manipulator links

ml 0.3921kg

m2 1.5108 kg

m3 1.5108 kg

Underwater manipulator link lengths

L i 0.05 m

L 2 0.20 m

L 3 0.20 m

Underwater manipulator link radii

n 0.10 m

r2 0.05 m

r3 0.05 m

Coefficient of drag (CD) 1.25

Coefficient of lift (CL) 1.15

Table 3: The values of hydrodynamic coefficients calculated using

empirical relations based on strip theory.

Vehicle added mass derivatives

-1.11kg Kp -0.1 kgm/rad

YV -34.84 kg M, -1.03 kgm

Yr 1.04 kgm M* -2.66 kgm/rad

z,, -34.83 kg NV -1.04 kgm

Z* -1.04 kgm Nf. -2.65 kgm/rad

Vehicle hydrodynamic parameters

Xu\u\ -1.365 kg/m Xu -2.12 kg/s

xv\v\ -0.131 kg/m X„ -0.31 kg/s

Xw\w\ -0.131 kg/m X, -0.31 kg/s

Xq\q\ -1.065 kgm/rad X* -0.51kgm/s

Xr\r\ -1.065 kgm/rad Xr -0.51kgm/s

yv\v\ -112.2 kg/m YV -62.45 kg/s

y r\r\ 0.250 kgm/rad Yr 0.12 kgm/s

Zw\w\ -112.2 kg/m Z, -62.45 kg/s

z*\*\ -0.250 kgm/rad Z* 0.12 kgm/s

Kp\p\ -0.5915 kgm2/rad2 Kp -0.3125 kgm2/s

Mw\w\ 2.244 kgm/rad Mw 1.2kgm/s

M*\*\ -119.5 kgm2/rad2 M* -59.15 kgm2/s

K\v\ -2.244 kgm/rad NV 1.2kgm/s

as sway in and out and heave up and down. The average value of sway velocity is 0.25 m/s (=0.5 knots) (same value for heave as well). This task is performed to identify the influences of

Desired 3D path ---PID with arm

...... PID without arm - MRC with arm

----MRC without arm

Figure 5: Comparative trajectory tracking control results.

Table 4: Controller parameter settings for simulations.

Vehicle controller parameters Values

KpV diag(4.2, 2.2, 2.5, 0, 25, 27)

diag(2.25,1.2,1.3, 0,15,13)

Kjy diag(0.5, 0.2, 0.3, 0, 2.5, 2.2)

Kpv diag(180,130,150, 0,150,130)

diag(80,100,100, 0, 80, 90)

diag(15,12,15, 0,16,18)

Manipulator controller parameters Values

diag(5,10,12)

^R diag(3, 5, 8)

diag(0.1, 0.2, 0.2)

KpR diag(60, 80, 75)

^dr diag(35, 40, 50)

diag(1,1.5, 2)

the underwater manipulator effects during vehicle tracking control. In the second task, the vehicle is free to move (no control action involved) and the manipulator has a certain repeated desired trajectory. This task is mainly performed to identify the vehicle behavior during manipulator motion. In all the above tasks, the initial velocities and positions of the vehicle and the manipulator are chosen to be zero, and the initial desired and actual positions and orientations are the same. In the third task, two basic trajectories for the manipulator have been chosen for simulations, a circular trajectory (in 3D space) and a rectangular trajectory (in yz plane) along with a straight line in 3D space. This is for the reason that most of the underwater intervention tasks involve these types of trajectories and also we can arrange any spatial trajectory by combining these trajectories. For the rectangular trajectory, we have selected a cubic polynomial function as the trajectory function, which imposes that the trajectory is continuous and smooth.

In the performance analysis, the sensory noises in position and orientation measurements are introduced and we have considered Gaussian noise of 0.01m mean and 0.01 m standard deviation for the position measurements and 0.2° mean and 0.2° standard deviation for the orientation measurements. The thruster dynamic characteristics are also incorporated in the simulations. All the vehicle thrusters are considered as an identical one, and the following thruster characteristics are considered for the analysis: the thruster response delay time is 200 ms, efficiency is 95% and saturation limits are ±20 N. The vehicle surge thrusters are located at 0.5 m from the body centre along the x-axis and offset each side 0.3 m from y-axis. The lateral thruster is exactly located on the body centre, and vertical thrusters are placed on the x-axis 0.4 m apart from the centre at each side. The controller update rate and sensor response time are considered as 100 ms each.

4.3. Results and Discussions. Here, numerical simulation results are shown and discussed to investigate the dynamic

coupling effects and the effectiveness of the proposed modelbased control scheme, which is expected to provide an intuitive, promising prospective of the proposed approach.

4.3.1. Underwater Vehicle Tracking a Given 3D Trajectory with the Underwater Manipulator. In this case, as mentioned earlier, the vehicle is commanded to follow a given 3D desired trajectory. The desired 3D trajectory is given in Figure 5. The controller gain values are tuned based on the genetic algorithms (GA) for minimizing the integral squared error (ISE) as the cost/objective function [23]. Here, we have considered both the model reference control and the PID control performance to be almost equal in the ideal situation, which makes the controller performance comparison quite reasonable and gives much better way of understanding. Based on the GA tuning method, the controller parameters are obtained and given in Table 4. The same set of controller parameters are used throughout the entire performance analysis.

Initially, the performance analysis is carried out for the vehicle trajectory tracking without manipulator inclusion. The actual simulated trajectories based on MRC and PID are presented in Figure 5. These results show that both controllers are good enough to track the given trajectory, and the tracking errors are within the design limits (error limits for the vehicle during trajectory tracking are ±0.2 m and ±0.2° in positions and orientations, resp.) as well. The tracking errors are presented in Figures 6, 7, 8, 9, 10, and 11. In the second set of simulations, the manipulator is included and the inclusion effects during trajectory tracking of the vehicle are considered. Here, the manipulator links are folded and arranged in such a way that the influences on the vehicle dynamics are small (i.e., manipulator joint angles are = 180°, 02 = 0°, and 03 = 180°). The manipulator inclusion shows that there are significant performance changes in the vehicle trajectory tracking, especially during the heave and sway motion tracking. The heave, roll, and pitch motions of the vehicle are greatly influenced by the underwater manipulator inclusion, which are replicated in the results

50 100 150 200

Time (t) (s)

■ ■ ■ PID without arm ---PID with arm

- MRC without arm - MRC with arm

0 50 100 150 200

Time (t) (s)

...... PID without arm

----MRC without arm

---PID with arm

- MRC with arm

Figure 6: Tracking errors in % position for a given 3D trajectory.

Figure 8: Tracking errors in z position for a given 3D trajectory.

> ¡1 ; ■ i

h 1 ; ;

50 100 150 200

Time (t) (s)

...... PID without arm

----MRC without arm

---PID with arm

- MRC with arm

50 100 150 200 250

Time (t) (s)

PID without arm MRC without arm

---PID with arm

- MRC with arm

Figure 7: Tracking errors in y position for a given 3D trajectory.

Figure 9: Tracking errors in roll for a given 3D trajectory.

(refer to Figures 6 to 11). However, the manipulator inclusion effects are better adapted in the model reference control than in the PID control. As can be observed from Figures 8 and 10, the manipulator inclusion causes an initial pitch angle variation drifts the vehicle in the heave direction during the straight line motion (during acceleration stage). However, these unwanted effects are compensated successfully in the model reference control and therefore tracking errors do not exceed their design limits.

4.3.2. Manipulator following a Given Desired 3D Trajectory with the Freely Moving Underwater Vehicle (without Vehicle Control). As mentioned earlier in this section, this task is mainly to address the interaction effects and their influences

on the UVMS. For this task, the vehicle controller is removed, and only the underwater manipulator follows a given desired continuous trajectory. The desired values of joint positions are as follows: 9ld = 90° sin (0.1t), d2d = 90°, and 93d = -45°. The simulation results of this condition are presented in Figures 12,13,14,15, and 16. From the results, it is observed that the vehicle is started, getting drifted from its initial position, and it is moving forward with an average velocity of 0.02 m/s (approximately) for the repeated underwater manipulator movements. It shows that the manipulator links are affected due to the dynamic coupling effects. From the results, it is observed that the vehicle swims during manipulator movements if the vehicle does not have any control action. These errors and forward speed are increasing

-a 1 3

i/\ i A j!

i- - "'A / i m \

: i \l

50 100 150 200 Time (t) (s)

...... PID without arm

----MRC without arm

---PID with arm

- MRC with arm

Figure 10: Tracking errors in pitch for a given 3D trajectory.

N \ d. Jk

¡1 p// j| I : il ;/J

50 100 150 200 Time (t) (s)

PID without arm MRC without arm

---PID with arm

- MRC with arm

Figure 11: Tracking errors in yaw for a given 3D trajectory.

with the manipulator oscillation frequency and their joint angle magnitudes. In addition, the direction of the vehicle's movement varies depending on the manipulator positions and its direction of movements. These results can be extended to the work towards swimming robots and their dynamic modeling aspects.

4.3.3. Underwater Manipulator following a Given Desired Circular Trajectory with Vehicle Control. The circular trajectory chosen for the analysis has 0.2 m in diameter and an average speed of 0.0125 m/s. These parameters are chosen with the consideration of manipulator actuators, workspace, and control. The results from computer simulations are presented in Figures 15-18. In Figure 15, both desired and actual task space trajectories are plotted, and the task space tracking errors are given in Figures 16-18. From the results,

Time (t) (s)

-"- ye

Figure 12: Tracking errors in the vehicle positions (when manipulator has motion).

Time (t) (s)

— 9e

Figure 13: Tracking errors in the vehicle orientations (when the vehicle has no control and the manipulator has repeated motion).

it is observed that the manipulator tip tracks the given desired task space trajectories quite satisfactorily, in both PID and MRC schemes in the ideal conditions (no disturbances, no uncertainties, etc.). Then, in order to demonstrate the adaptability and robustness of the proposed controller, an uncertain condition is considered for the simulations. The following conditions are considered for the uncertain condition analysis:

(i) the UVMS parameters are assumed to be inaccurate (about 10% for each parameters);

(ii) the manipulator carries a payload of 1 kg at its tip;

...... Desired tool tip position

- Actual tool tip position

Figure 14: Manipulator tip position in 3D space (when the vehicle has no control).

0.05 0

-0.05 -0.1 0.15

Desired trajectory ----PID with uncertainty

...... PID - MRC with uncertainty

---MRC

Figure 15: Task space (xyz) trajectories (results from the circular trajectory).

(iii) an unknown ocean current is added in the simulation by properly considering the relative velocity of the in the dynamic model. It is assumed to have an irrotational current, constant in the inertial frame, and the value of the current is considered as vc = [0.2 0.2 0.1 0 0 0]T m/s.

The results are presented in Figures 15-18, and from these results it is observed that the proposed controller is good in adapting the uncertainties and disturbances (refer to Figure 15). Figures 16 and 17 show that tracking errors of x and y in both PID and MRC methods are almost the same and results satisfactorily; however, the tracking error in z substantiates that the proposed controller is comparatively good in the presence of uncertainties and disturbances.

4.3.4. Underwater Manipulator following a Given Desired Rectangular Trajectory with Vehicle Control. The rectangular trajectory chosen for the analysis has 0.4 m in width and

-0.005

-0.015

i \ 1 k :1 \

i l "A n"'"": '

~ r \ V "s i \ i/ v y : V;

......ni.......i""

......:.....Ii:.......:.......

...... PID

-- MRC

10 15 20

Time (t) (s)

----PID with uncertainty

- MRC with uncertainty

Figure 16: Time histories of the manipulator tip position tracking error in x (circular trajectory).

5 4 3 2 1 0 -1 -2 -3 -4

Time (t) (s)

...... PID

---MRC

----PID with uncertainty

- MRC with uncertainty

Figure 17: Time histories of the manipulator tip position tracking error in y (circular trajectory).

0.2 m in height in the yz plane and an average speed of 0.05 m/s. As mentioned in the last case, the trajectory has been chosen with the consideration of the manipulator characteristics. Two conditions have been considered for the analysis: ideal condition (no disturbances, no uncertainties, etc.) and an uncertain condition (the same as the previous case Section 4.3.3). The results from computer simulations are plotted in Figure 19. In the ideal condition both controllers show quite satisfactory performance, and in the uncertain condition the proposed controller shows better performance.

X 0.08

e 0.06

:u C 0.04

o sp 0.02

/ \ i \ / \

' 1 Y' f v í \

' \ 1 \

! \ ' \

Time (t) (s)

----PID with uncertainty

- MRC with uncertainty

Figure 18: Time histories of the manipulator tip position tracking error in z (circular trajectory).

UVMS to perform underwater intervention tasks incorporating desired trajectory information. Extensive simulations were carried out to verify and demonstrate the effectiveness of the proposed scheme. In particular, the performance of the model reference controller is compared with that of the conventional PID controller for the given UVMS operation scenarios. The obtained results confirm the effectiveness and robustness of the proposed scheme in terms of tracking errors and control effort in the presence of external disturbances and parameter uncertainties. This research provides a generalized framework for modeling and controlling of an UVMS considering the dynamic coupling between the vehicle and the manipulator, which is crucial for achieving underwater manipulation tasks for a variety of scientific, industrial, and military missions using unmanned underwater vehicles.

Conflict of Interests

Authors confirm that this paper has not been published elsewhere and is not under consideration by another journal. All authors have approved the manuscript and agree with submission to Modelling and Simulation in Engineering. The authors have no conflict of interests to declare.

0.4 -^ 0.35 -

^ 0.3 -0.25 - - '

Desired trajectory ----PID with uncertainty

...... PID - MRC with uncertainty

---MRC

Figure 19: Task space (xyz) trajectories (results from the rectangular trajectory).

In both trajectory tracking cases, the thruster forces do not exceed ±5N, and the manipulator actuator torques stay within ±0.15 Nm, which are well within the range of actuators.

5. Conclusions

In this study, the interaction effects due to the dynamic coupling between the vehicle and the manipulator were investigated using closed-form equations which provide a generalized scheme for formulating the equations of motion of the UVMS. The proposed scheme makes it possible to identify the structure, nature, and properties of the system, and it simplifies the control design. This study also proposed a model reference control approach for an underactuated

Acknowledgments

The author would like to acknowledge Professor Jinwhan Kim for his valuable suggestions and discussions on underwater manipulator. This research was supported in part by the World Class University (WCU) program through the National Research Foundation of Korea funded by the Ministry of Education, Science and Technology (R31-2008-000-10045-0).

References

[1] G. Antonelli, F. Caccavale, S. Chiaverini, and L. Villani, "Tracking control for underwater vehicle-manipulator systems with velocity estimation," IEEE Journal of Oceanic Engineering, vol. 25, no. 3, pp. 399-413, 2000.

[2] G. Marani, S. K. Choi, and J. Yuh, "Underwater autonomous manipulation for intervention missions AUVs," Ocean Engineering, vol. 36, no. 1, pp. 15-23, 2009.

[3] S. McMillan, D. E. Orin, and R. B. McGhee, "Efficient dynamic simulation of an underwater vehicle with a robotic manipulator," IEEE Transactions on Systems, Man and Cybernetics, vol. 25, no. 8, pp. 1194-1206,1995.

[4] T. I. Fossen, Guidance and Control of Ocean Vehicles, Wiley, Chichester, UK, 1994.

[5] T. J. Tarn, G. A. Shoults, and S. P. Yang, "A dynamic model of an underwater vehicle with a robotic manipulator using Kane's method," Autonomous Robots, vol. 3, no. 2-3, pp. 269-283,1996.

[6] H. Mahesh, J. Yuh, and R. Lakshmi, "A Coordinated control of an underwater vehicle and robotic manipulator," Journal of Robotic Systems, vol. 8, no. 3, pp. 339-370,1991.

[7] N. Sarkar and T. K. Podder, "Coordinated motion planning and control of autonomous underwater vehicle-manipulator systems subject to drag optimization," IEEE Journal of Oceanic Engineering, vol. 26, no. 2, pp. 228-239, 2001.

[8] T. W. McLain, S. M. Rock, and M. J. Lee, "Experiments in the coordinated control of an underwater arm/vehicle system," Autonomous Robots, vol. 3, no. 2-3, pp. 213-232,1996.

[9] M. W. Dunnigan and G. T. Russell, "Evaluation and reduction of the dynamic coupling between a manipulator and an underwater vehicle," IEEE Journal of Oceanic Engineering, vol. 23, no. 3, pp. 260-273,1998.

[10] B. H. Jun, P. M. Lee, and J. Lee, "Manipulability analysis of underwater robotic arms on ROV and application to task-oriented joint configuration," in Proceedings of the IEEE OCEANS, pp. 1548-1553, November 2004.

[11] J. H. Ryu, D. S. Kwon, and P. M. Lee, "Control of underwater manipulators mounted on an ROV using base force information," in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA '01), pp. 3238-3243, May2001.

[12] M. Hildebrandt, L. Christensen, J. Kerdels, J. Albiez, and F. Kirchner, "Realtime motion compensation for ROV-based tele-operated underwater manipulators," in Proceedings of the IEEE OCEANS, pp. 1-6, May 2009.

[13] H. Shim, B. H. Jun, P. M. Lee, H. Baek, and J. Lee, "Workspace control system of underwater tele-operated manipulators on an ROV," Ocean Engineering, vol. 37, no. 11-12, pp. 1036-1047, 2010.

[14] J. J. Craig, Introduction to Robotics, Addison Wesley, Boston, Mass, USA, 1986.

[15] G. Antonelli, Underwater Robots: Motion and Force Control of Vehicle-Manipulator Systems, Springer, Berlin, Germany, 2006.

[16] K. Kim and T. Ura, "Applied model-based analysis and synthesis for the dynamics, guidance, and control of an autonomous undersea vehicle," Mathematical Problems in Engineering, vol. 2010, Article ID 149385, 23 pages, 2010.

[17] T. I. Fossen, Marine Control Systems: Guidance, Navigation and Control of Ships, Rigs and Underwater Vehicles, Marine Cybernetics AS, 2002.

[18] J. J. E. Slotine and W. Li, Applied Nonlinear Control, Prentice-Hall, Upper Saddle River, NJ, USA, 1991.

[19] K. Y. Pettersen and O. Egeland, "Position and attitude control of an underactuated autonomous underwater vehicle," in Proceedings of the 1996 35th IEEE Conference on Decision and Control, pp. 987-991, Kobe, Japan, December1996.

[20] T. H. Koh, M. W. S. Lau, G. Seet, and E. Low, "A control module scheme for an underactuated underwater robotic vehicle," Journal of Intelligent and Robotic Systems: Theory and Applications, vol. 46, no. 1, pp. 43-58, 2006.

[21] M. Santhakumar and T. Asokan, "Investigations on the hybrid tracking control of an underactuated autonomous underwater robot," Advanced Robotics, vol. 24, no. 11, pp. 1529-1556, 2010.

[22] ANSALDO Nucleare, Underwater Manipulator MARIS, 7080 Use and Maintenance Manual, Ansaldo Nuclear Division, Genoa, Italy, 1996.

[23] K. Deb, Optimization for Engineering Design: Algorithms and Examples, Prentice Hall, New Delhi, India, 2004.

Copyright of Modelling & Simulation in Engineering is the property of Hindawi Publishing Corporation and its content may not be copied or emailed to multiple sites or posted to a listserv without the copyright holder's express written permission. However, users may print, download, or email articles for individual use.