Simulation and Dynamic Analysis of Remotely Operated Vehicle (ROV) Using PID Controller For Pitch Movement
Simulation and Dynamic Analysis of Remotely Operated Vehicle (ROV) Using PID Controller For Pitch Movement
Abstract—ROV (Remotely Operated Vehicle) is a type of velocity plot with respect to time. The output of this research is
underwater robot that resembles a mini submarine. The robot is an ROV design that is based on mathematical model.
remotely controlled by a pilot. In this ROV tether is usually used to
link the robot with devices such as the sea surface energy source, A. ROV (Remotely Operated Vehicle)
remote control and sensing display. This study started from the stage A typical ROV consists of frame, thruster, control system/
of modeling the body of the ROV using SolidWorks. Estimation of
box, and camera.
added mass coefficient and hydrodynamics damping was performed
using first principle approach. This leads to development of the
equations of motion of ROV describing its salient dynamics. Based on
the mathematical model, the ROV motion in 3-D space was
investigated by using MATLAB SIMULINK. The stability of the
ROV was analyzed and a classical control design was performed using
the PID control toolbox.
Keywords—ROV, PID controller, virtual reality, dynamic model.
I. INTRODUCTION
B. Coordinate System, Definition of Kinematics and Position II. DYNAMIC MODELING OF ROV
of ROV A. Kinematic Model of ROV
Coordinate system is important to explain the motion of Kinematics is part of dynamics, which is study about motion
underwater vehicle in six degrees of freedom (DOF) and to
of objects without regard to the forces that influence the motion
determine position and orientation in three dimensional volume
of the objects. Description of kinematics from ROV is based on
and time. The 6 DOF motion is described as position and
translational velocity where X, Y, Z, and ϕ, θ, ψ are for two types of reference, which is, body-fixed coordinate system
orientation and rotational velocity, respectively. For and earth-fixed coordinate system. Earth-fixed coordinate
underwater robots, those motion variables are termed as surge, system is used as the inertial reference with assumption that
sway, heave, roll, pitch, and yaw. Position or translational earth is superficial and its motion is neglected [4]. For object
motion and orientation or rotational motion of a rigid body (a moving in three dimensions, variables that must be considered
body in which the relative position of all its points is constant) in the kinematic model are:
can be described with respect to a reference position. For this
purpose, some set of orthogonal coordinate axes are chosen and η1 =[x y z]T (1)
assumed to be rigidly connected to the arbitrary origin of the η2 =[ϕ θ ψ]T (2)
body to build up the reference frame.
v1 =[u v w]T (3)
Force and moment that work in underwater vehicle must be
referenced to the same frame as the motion variables. The v2 =[p q r]T (4)
notation that is used to explain 6 degree of freedom (DOF) is
summarized in TABLE I. Note that convention of symbols for τ1 =[X Y Z]T (5)
underwater vehicle is: x as positive direction in the front, y as τ2 =[K M N]T (6)
positive direction in the right hand, z as positive direction in the
bottom and rule of right hand is used for angle [3]. vector 𝜂 is position and orientation coordinate about ROV in
TABLE I NOTATION OF STANDARD MOTIONS [3] the reference of earth-fixed coordinate system, whereas vector
𝑣 is velocity vector, and each 𝜏 respectively represents external
Linear and
Forces and Positions and force vector and external moment vector that acts on ROV
DOF Motions Angular
Moments Orientations
Velocities body. To obtain the kinematic expression of ROV, the
1 Surge X U x formulation must be transformed from body-fixed coordinate
system to earth-fixed coordinate system. The transformation
2 Sway Y V y
matrix is usually written as follows [4]:
3 Heave Z w z
4 Roll K p ϕ η̇ 1 =J1 (η2 )v1 (7)
5 Pitch M q θ ẋ u
6 Yaw N r ψ [ẏ ] =J1 (η2 ) [ v ] (8)
ż w
Figure 2 shows the determination of body-fixed coordinate
system and earth-fixed coordinate system that are used as
c ψcθ -s ψ c θ + c ψ s θ s ϕ s ψ s ϕ+ c ψ s θ c ϕ
standard motion as has been summarized in TABLE .
J1 (η2 )= [s ψ c θ cψcθ+sψsθsϕ -c ψ s ϕ+ s ψ s θ c ϕ] (9)
-sθ cθsϕ cθcϕ
-1 T
(J1 (η2 )) = (J1 (η2 )) (10)
ϕ̇ =p+q(s ϕ t θ)+r(c ϕ t θ) (16) where j, k, l, the value of 1, 2, and 3, while i is used as a six
speed components.
θ̇ =q c ϕ-r s ϕ (17)
Ui are the three components the speed of translational (surge,
ψ̇ =q s ϕ / c θ+r c ϕ/ c θ (18)
sway, heave) and Ω1=U4, Ω2=U5, Ω3=U6, are the three
components the speed of rotation (roll, pitch, yaw). Alternating
B. Dynamic Model of ROV Tensor +1 if the index is equal to the cyclic order (123, 231,
Based on Newton’s Second Law, derivation of the 312), equal to -1 if the index acyclic (132, 213, 321) and zero if
equations of motion will derive the complete the same index.
three-dimensional, six degree of freedom (DOF) rigid body Since the plane xz plane is symmetric (right/ leftside thruster
governing equations, that will briefly work through the symmetry), then the additional mass matrix is as follows:
derivation of the dynamic equation of the general form
𝐹 = 𝑚 ∙ 𝑎, where F is external force that is working on the 𝑋𝑢̇ 𝑋𝑣̇ 𝑋𝑤̇ 𝑋𝑝̇ 𝑋𝑞̇ 𝑋𝑟̇
central of mass of the objects (N), whereas 𝑚 ∙ 𝑎 is the product 𝑌𝑢̇ 𝑌𝑣̇ 𝑌𝑤̇ 𝑌𝑝̇ 𝑌𝑞̇ 𝑌𝑟̇
of mass (kg) and acceleration (m/s2). External forces consist of 𝑍𝑢̇ 𝑍𝑣̇ 𝑍𝑤̇ 𝑍𝑝̇ 𝑍𝑞̇ 𝑍𝑟̇
𝑀𝐴 = − (27)
radiation-induced, environmental and propulsive forces. 𝐾𝑢̇ 𝐾𝑣̇ 𝐾𝑤̇ 𝐾𝑝̇ 𝐾𝑞̇ 𝐾𝑟̇
Radiation-induced forces consist of hydrodynamics damping 𝑀𝑢̇ 𝑀𝑣̇ 𝑀𝑤̇ 𝑀𝑝̇ 𝑀𝑞̇ 𝑀𝑟̇
force and restoring force. Although derivation of dynamic [𝑁𝑢̇ 𝑁𝑣̇ 𝑁𝑤̇ 𝑁𝑝̇ 𝑁𝑞̇ 𝑁𝑟̇ ]
equation is taken from various references, in this paper,
summary of how to get the complete data for the motion Because the inspection position of the center point of the
dynamic equation of ROV is presented [5][6][7]. ROV, non-zero added mass can be reduced to a simpler matrix,
the matrix equation to obtain non-zero added mass for the
Axial force equation (surge): ROV. ROV design assumptions of symmetry on the left and
∑ Xext =m [u̇ +wq-vr-xG (q2 + r2 )+ zG (pr+ q̇ )] (19) right side cross section as follows:
∑ Next =Izz ṙ +(Iyy -Ixx )pq+m[zG (v̇ +ur-wp)] (24) Surge added mass force:
C. Added Mass 𝑋𝐴 = 𝑋𝑢̇ 𝑢̇ + 𝑋𝑤̇ (𝑤̇ + 𝑢𝑞) + 𝑋𝑞̇ 𝑞̇ + 𝑍𝑤̇ 𝑤𝑞 + 𝑍𝑞̇ 𝑞2 − 𝑌𝑣̇ 𝑣𝑟
25
Marine and Underwater Science and Technology 26
Heave added mass force: To be precise damping coefficient hydrodynamic forces and
moments for the three coordinates of the objects is as follows
𝑍𝐴 = 𝑋𝑤̇ (𝑢̇ − 𝑤𝑞)𝑍𝑤̇ 𝑤̇ + 𝑍𝑞̇ 𝑞̇ − 𝑋𝑢̇ 𝑢𝑞 − 𝑋𝑞̇ 𝑞2 + 𝑌𝑣̇ 𝑣𝑝 𝑋𝐷 , 𝑌𝐷 , 𝑍𝐷 , 𝐾𝐷 , 𝑀𝐷 , 𝑁𝐷 where:
+ 𝑧𝐺 (𝑝𝑟 + 𝑞̇ )} = 𝑋𝑢̇ 𝑢̇ + 𝑋𝑤̇ (𝑤̇ + 𝑢𝑞) + 𝑋𝑞̇ 𝑞̇ + 𝑍𝑤̇ 𝑤𝑞 −(𝐾𝑝̇ − 𝑀𝑞̇ )𝑝𝑞 − 𝐾𝑟̇ 𝑞𝑟 + 𝑁𝑟|𝑟| 𝑟|𝑟|
+𝑍𝑞̇ 𝑞 2 − 𝑌𝑣̇ 𝑣𝑟 − 𝑌𝑝̇ 𝑟𝑝 − 𝑌𝑟̇ 𝑟 2 +𝑁𝑣|𝑣| 𝑣|𝑣| + (𝑥𝐺 𝑊 − 𝑥𝐵 𝐵) 𝑐𝑜𝑠 𝜃 𝑠𝑖𝑛 𝜙
+𝑋𝑢|𝑢| 𝑢|𝑢| − (𝑊 − 𝐵) sin 𝜃 + 𝐹𝑟𝑠𝑡 + 𝐹𝑙𝑠𝑡 (53) +(𝐹𝑟𝑠𝑡 − 𝐹𝑙𝑠𝑡 ) (58)
Sway (∑ 𝑌𝑒𝑥𝑡 ): III. PID CONTROLLER AND SIMULATION
27
Marine and Underwater Science and Technology 28
also very small. The ROV only travelled 0.033 m from its 12
initial point within 50 secs.
10
(deg)
results indicate that the feedback control is effective in 6
0
The controlled heaving motion of the ROV is characterized
-2
by vertical displacement with negative pitch angle. Figure 10 0 5 10 15 20 25 30 35 40 45 50
Time (s)
shows that the ROV starts its vertical motion pitching down. Figure 8 Orientation of the pitch angle in hovering condition
This is an indication that the system is slightly non-minimum
x Position vs Time
phase. The maximum pitch angle was -1.8 degree and it 0.035
within the above time frame with the maximum speed of 0.25
0.02
m/s which is achieved within 5s from its initial zero velocity.
x (m)
The steady state velocity is achieved quickly without an 0.015
overall satisfactory.
0.005
0.2
0.996 Damping: 1 Damping: -1
Overshoot (%): 0
Frequency (rad/s): 0.000134
Overshoot (%): 0
Frequency (rad/s): 1.8
-0.8
2 1.75 1.5 1.25 1 0.75 0.5 0.25
0
System: sys
Pole : 1.48 -1
0.996 Damping: -1
-0.2 Overshoot (%): 0
Frequency (rad/s): 1.48
0.984
-1.2
-0.4
0.96
-1.4
-0.6
-1.6
-0.8
0.92
29
Marine and Underwater Science and Technology 30
x (m)
25
step forward velocity profile. The steady state forward velocity
20
of 0.92 m/s was achieved within 15s with a slight overshoot. As
15
in hover and heave modes, the control for the surge motion is
effective. We can conclude that the ROV is fully controllable in 10
u (m/s)
z Position vs Time
14 0.5
0.4
12
0.3
10
0.2
8 0.1
z (m)
0
6 0 5 10 15 20 25 30 35 40 45 50
Time (s)
4
Figure 13 Position and velocity in surge motion
2
0
V. CONCLUSIONS
0 5 10 15 20 25 30 35 40 45 50
Time (s) The work is focused on the modeling, simulation and control
w Velocity vs Time
0.25
of the ROV. The ROV was first designed by using the
SolidWorks optimizing the balance between the gravitational
0.2
and buoyancy forces to enable the vehicle to float. The
0.15
mathematical model of the ROV was developed based on
w (m/s)
6
Loop (HIL) simulation environment.
4
ACKNOWLEDGEMENTS
2
REFERENCES
[1] Alim, A.S., 2008, Evaluasi Kebijakan Dalam Rangka Implementasi
Konvensi Hukum Laut International (UNCLOS 1982) di Indonesia,
Departemen Kelautan dan Perikanan Sekertariat Jenderal Satuan Kerja
Dewan Kelautan Indonesia, Jakarta, Indonesia.
[2] Chandra,Y., Purnomo, D.K., Suryawati N, E., 2011, Rancang Bangun
Sistem Ballast Pada ROV (Remotely Underwater Vehicle), Jurusan
Teknik Mekatronika-Politeknik Elektronika Negeri Surabaya, Institut
Teknologi Sepuluh Nopember (ITS) Surabaya.
[3] Fossen, T.I., 1994, Guidance and Control of Ocean Vehicles, John Wiley
and Sons.
[4] Geridonmez, F., 2007, Simulation Of Motion Of An Underwater Vehicle,
Master Thesis, Aerospace Engineering Department, Middle East
Technical University.
[5] Chuan, T.S., 1999, Modeling and Simulation of the Autonomous
Underwater Vehicle, Autolycus, Master Thesis, Department of Ocean
Engineering, Massachusetts Institute of Technology, USA.
[6] J. N. Newman. 1997. Marine Hydrodynamics. Massachusetts Institute of
Technology Press.
[7] S. H. Hoerner. 1965. Fluid Dynamic Lift. Hoerner Fluid Dynamics.
[8] Lin F. 2007. Robust Control Design: An Optimal Control Approach. John
Wiley Sons. England. CrossRef
[9] Budiyono, A. et al. Intelligent Unmanned Systems: Theory and
Applications. Springer-Verlag Berlin Heidelberg. 2009. CrossRef
[10] Siong Chin, Cheng. 2013. Computer-Aided Control Systems Design.
New York: CRC Press Taylor and Francis Group.
[11] Agus Budiyono, Muljowidodo Kartidjo and Agus Sugama, Coefficient
Diagram Method for the Control of an Unmanned Underwater Vehicle, ,
Indian J Mar Sci., 38(3):316-323, Sept. 2009
[12] Budiyono, A. "Robust Control Synthesis for an Unmanned Underwater
Vehicle." World Academy of Science, Engineering and Technology 60
(2009): 48-55
[13] Budiyono, Agus. "Model predictive control for autonomous underwater
vehicle." Indian Journal of Marine Sciences 40.2 (2011): 191
[14] H.Y. Sutarto and Agus Budiyono, Development of linear parameter
varying control system for autonomous underwater vehicle, Indian J
Geo-Mar Sci., 40(2):275-286, Apr. 2011
[15] Budiyono, A., Advances in Unmanned Underwater Vehicles
Technologies, Indian J Mar Sci., 38(3):282-295, Sept. 2009
[16] Kaliappan, VK, Budiyono, A and Min, D. "Hardware-In-the-loop
simulation platform for the design, testing and validation of autonomous
control system for unmanned underwater vehicle." Indian Journal of
Geo-Marine Sciences 41.6 (2012): 575-580.
31