Академический Документы
Профессиональный Документы
Культура Документы
DOI 10.1007/s11071-014-1431-0
ORIGINAL PAPER
1 Introduction
Autonomous underwater vehicles (AUVs) have been
increasingly used for a variety of tasks in underwater environments including geological survey and data
collection. For underwater surveys using AUVs, precise control is very important because the quality of
data obtained is highly dependent on the vehicles control accuracy in station-keeping and trajectory tracking.
However, control of an AUV is difficult due to coupled
nonlinearities, parameter uncertainties resulting from
the lack knowledge of hydrodynamic coefficients, and
external disturbances such as waves and currents.
Considerable research has been conducted to address
these problems, and various robust control strategies
have been proposed for an AUV. These include a
PID controller [1] and multivariable sliding-mode controller (SMC) for steering, diving, and speed control
[2]; a decoupled PD and variable-structure PID controllers [3,4]; the SMC for tracking control [5]; a
second-order SMC (2-SMC) [6,7]; an output-feedback
2-SMC [8]; a full-order H controller [9,10]; an H
controller to decrease the coupling between pitch and
yaw motion [11]; and backstepping and sliding-mode
techniques [12,13].
123
H. Joe et al.
2 System modeling
2.1 AUV modeling
The motion of the AUV can be described using a
body frame relative to a navigation frame (Fig. 1). The
body frame is composed of the AUVs linear velocities
[u v w] and angular velocities [ p q r ]. The navigation
frame is composed of the AUVs positions [x y z] and
orientation [ ]. In this paper, we neglect roll and
pitch motions, and consider only horizontal and vertical motions that correspond to the linear velocities
[u v w], the angular velocity [r ], the position [x y z],
and the orientation []. The 4-DOF model was pre-
123
(1)
(2)
(3)
(4)
(5)
(6)
z (t) = w(t),
(t)
= r (t),
(7)
(8)
3 Controller design
Each motion in surge and sway is coupled with the
motion in yaw. In this paper, we design the controller
in surge and sway in conjunction with an autopilot for
heading control, so we can assume that (t) c
and r (t) 0; c is constant. In addition, parameters in
hydrodynamics are uncertain and external disturbances
in hydrodynamics exist.
Considering (t) c and r (t) 0, the hydrodynamic parameter uncertainties, and external disturbances, we can rewrite the dynamic system (1)(8) as
x 1 (t) = J(c )x2 (t),
x 2 (t) = A(x2 (t)) + BF(t) + D(t),
(9)
(10)
cos c sin c 0
J(c ) = sin c cos c 0 ,
0
0
1
(11)
(13)
ei ( )d +kdi e(t),
(14)
ku|u|
m u u(t)|u(t)|,
and
(12)
(15)
(16)
123
H. Joe et al.
(19)
(20)
(22)
(23)
(21)
123
3.2 Stability
1 if x < 0
sgn(x) 0
if x = 0
1
if x > 0,
(24)
y2 (t)sgn(y1 (t))
y2 (t)2
k
2
+ k0 |y1 (t)| + 2
if y1 (t)y2 (t) = 0
(25)
Vi (t) = 2
if y1 (t) = 0
k y2 (t)2 /4
|y1 (t)|/4
if y2 (t) = 0,
where Vi (t) > 0 for y1 (t) = 0, y2 (t) = 0, and =
ksw1i + ksw2i sgn(y1 (t)y2 (t)) D i (t)sgn(y1 (t)y2 (t)).
and k0 are positive constants, and are set to remove
k, k,
the discontinuities of the Lyapunov function candidate
at y1 (t) = 0 and y2 (t) = 0. Differentiating Vi (t) with
respect to time yields
dVi (t)
Vi (t)
Vi (t)
=
y1 (t) +
y2 (t)
dt
y1 (t)
y2 (t)
21
1
y2 (t)2
sgn(y1 (t)) y2 (t)
= k Vi (t) k0 |y1 (t)| +
2
2 (t)
sgn(y1 (t))
+ k Vi (t)
(t)
21
y2 (t)
y2 (t)2
1
+ k0 |y1 (t)| +
y2 (t)
2
2 (t)
(t)
(t)
= k Vi (t)
(t)
(t)
k0 sgn(y1 (t)y2 (t))
(t)
+
1
, (26)
2
4|y1 (t)|/y2 (t)2 + 2/ (t) (t)
(t)
+
(t)
(t)
(t)
(t)
1
(t)
(27)
(28)
(30)
Because Kp , Ki , and Kd are chosen such that the polynomial Kd e (t) + Kp e (t) + Ki e(t) becomes a Hurwitz
polynomial, e(t) is exponentially stable.
Remark 1 The conventional sliding-mode controller
has steady-state error when the AUV suffers from
constant disturbances such as currents and buoyancy.
The steady-state error can be eliminated by the integral term in the 2-SMC scheme. However, the integral
action may degrade the transient response by increasing its oscillation. Moreover, the integral windup phenomenon occurs when the integral action is used
in a system in which the actuator is saturated. The
integral windup may cause significant overshoot that
requires a long time for recovery. To reduce these
errors, we turn on the integral action only when the
norm of tracking errors is lower than a predetermined
value.
Remark 2 The switching control action in (31) may
cause chattering due to delay and the imperfection of
the switching device. Chattering results in wear-andtear on the thrusters so that the system can be damaged
in a short time. To reduce the chattering, we replace
123
H. Joe et al.
(31)
s1 (t)
s2 (t)
where tanh(1
1 s(t)) = [tanh( 11 ) tanh( 12 )tanh
s1 (t)
s2 (t)
)]T , tanh(1
( s3 (t)
2 s (t)) = [tanh( 21 ) tanh( 22 )
13
Remark 3 2-SMC has been applied to an electromechanical system [18], a chaotic system [20], and a
complex network [21]. The proposed controller structure is similar to these controllers, but differs in that
the coordinate transformation matrix is added during the control input derivation procedure. Moreover,
compared to electro-mechanical, chaotic, and network
systems, the AUV system is more difficult to control
because it experiences system uncertainties as well as
large unknown disturbances such as waves, tides, currents, and buoyancy.
Remark 4 Position-tracking controller and current
observer were developed to control an AUV in the
presence of unknown ocean currents in the horizontal plane [22]. That controller was based on Lyapunov
theory and backstepping technique. Compared to that
controller, proposed controller is simpler and easier to
implement.
Remark 5 Adaptive fuzzy controllers [2325] can be
applied to the AUV system. These controllers can estimate and compensate the unknown parameters in AUV
so that they can precisely control the AUV system.
However, in practice, it is difficult to choose an appropriate learning gain to estimate the unknown parameters.
4 Simulation
To demonstrate the feasibility of the developed controller, we conducted various computer simulations
123
with a model of the Cyclops AUV (Fig. 9). The controller parameters can be determined based on the parameter values of Cyclops (Table 3). Undetermined parameters are the gains of SMC and 2-SMC. A heuristic method was used to obtain these gains; the values obtained were i = 4, i = 0.5, ksw1i = 10
for SMC, k pi = 4, kii = 4, kdi = 1, i = 2,
ksw1i = 10, ksw2i = 5, 1i = 0.5, 2i = 0.5
for 2-SMC for all i = 1, 2, 3. For simplicity, we set
c = 0. We varied the linear/quadratic drag coefficients by 20 % from their true values for AUV
model. We added sinusoidal disturbances (e.g., waves)
with 10-N amplitude and 0.13-Hz frequency, and constant disturbances (e.g., currents) with 1-N amplitude
to surge and sway motions, uniformly distributed random signals with 10-N amplitude to surge, sway, and
heave motions, and constant disturbance (e.g., buoyancy) with 5-N amplitude to heave motion. Finally,
we set the sampling period to 100 ms and simulated this control scheme for 150 s using Matlab software.
Under the above settings and step input command,
we applied SMC, and 2-SMCs without and with switching controller (Figs. 4, 6, and 8). 2-SMC without the
switching controller is comprised of PD and feedback linearization controllers. We tested these controllers not for 3-dimensional motions but for each
motion, because the controllers are designed to be
decoupled with regard to 3-dimensional motions. In
surge and sway, 2-SMC without switching controller
worked poorly, because PD controllers in the 2-SMC
without the switching controller cannot reject the fast
sinusoidal disturbance. However, SMCs and 2-SMCs
with switching controller worked well (Figs. 3, 5),
because the switching controller can reject fast sinusoidal disturbance. In heave, 2-SMC without and SMC
with switching controller have a small steady-state
error due to the buoyancy force, but it can be eliminated because the 2-SMC with switching controller is
used (Fig. 7).
To show the accuracy of the proposed controller
quantitatively, we examined the root-mean square
(rms) error of the command input responses in surge,
sway, and heave (Table 1). 2-SMC with switching controller showed smaller rms error in steady state than
2-SMC without switching controller.
12
10
Distance (cm)
8
2SMC without
switching controller
(PD+Feedback Linearization)
2SMC with
switching controller
SMC with
switching controller
25
50
75
100
125
150
Time (s)
150
100
2SMC without
switching controller
(PD+Feedback Linearization)
2SMC with
switching controller
SMC with
switching controller
50
50
100
25
50
75
100
125
150
Time (s)
12
10
Distance (cm)
8
2SMC without
switching controller
(PD+Feedback Linearization)
2SMC with
switching controller
SMC with
switching controller
25
50
75
100
125
150
Time (s)
123
H. Joe et al.
Fig. 6 Controller input in
sway
300
200
2SMC without
switching controller
(PD+Feedback Linearization)
2SMC with
switching controller
SMC with
switching controller
100
100
25
50
75
100
125
150
Time (s)
12
10
Distance (cm)
8
2SMC without
switching controller
(PD+Feedback Linearization)
2SMC with
switching controller
SMC with
switching controller
25
50
75
100
125
150
Time (s)
300
250
200
2SMC without
switching controller
(PD+Feedback Linearization)
150
2SMC with
switching controller
SMC with
switching controller
100
50
50
25
50
75
Time (s)
123
100
125
150
Surge
Sway
Heave
2-SMC without
4.2 103
2.5 103
2.3 103
SMC with
1.1 103
6.2 104
5.6 104
2-SMC with
5.2 104
104
1.8 104
3.2
5 Experiment
5.1 Experimental setup
To demonstrate the feasibility of the developed controller, it was applied to Cyclops (Fig. 9), an AUV
developed at Hazardous Environmental Robotics
Laboratory at the Pohang University of Science and
Technology (POSTECH).
Cyclops measures 1477 868 920 mm and
weighs 219.8 kg. Two batteries are attached to its bottom and a buoyancy sheet is attached to its top. A cylinder to contain the electric system is located at its center. Cyclops is equipped with two thrusters for surge
motion, two thrusters for heave motion, four thrusters
123
H. Joe et al.
Fig. 10 The configuration
of Cyclops
Value
Maximum speed
2 knots
2h
100 m
Actuators
Batteries
Computer system
Sensors
123
disturbances. The only existing disturbance in the engineering basin is the buoyancy force. Therefore, among
surge, sway, and heave motions, only the heave motion
control test was conducted.
The control parameters were determined based on
actual measurements (Table 3). Undetermined parameters are the gains of SMC and 2-SMC. A heuristic method was used to obtain these gains; the values
obtained were 3 = 1.5, 3 = 0.1, ksw13 = 0.12
Definition
Value
920 mm
Height of cyclops
ku
16
kv
131.8
kw
65.6
ku|u|
229.4
kv|v|
328.3
kw|w|
296.8
Length of cyclops
1,477 mm
219.8 kg
mu
391.5 kg
mv
639.6 kg
mw
639.6 kg
Width of cyclops
868 mm
2.5 N
2 t
1 1
cos
.
2 2
100
(32)
1.2
1.0
Distance (m)
0.8
2SMC with
switching
controller
SMC with
switching
controller
2SMC without
switching controller
(PD+Feedback
Linearization)
0.6
0.4
0.2
25
50
75
100
125
150
Time (s)
123
H. Joe et al.
Fig. 13 Control input in
heave when the step input
command is applied
10
25
2SMC with
switching
controller
SMC with
switching
controller
2SMC without
switching controller
(PD+Feedback
Linearization)
50
75
100
125
150
500
600
500
600
Time (s)
1.4
2SMC with
switching
controller
SMC with
switching
controller
2SMC without
switching controller
(PD+Feedback
Linearization)
1.2
Distance (m)
1.0
0.8
0.6
0.4
0.2
100
200
300
400
Time (s)
15
10
2SMC with
switching
controller
SMC with
switching
controller
2SMC without
switching controller
(PD+Feedback
Linearization)
10
100
200
300
Time (s)
123
400
References
1. Jarving, B.: The NDRE-AUV flight control system. IEEE J.
Ocean. Eng. 19(4), 497501 (1994)
2. Healey, A.J., Lienard, D.: Multivariable sliding mode control for autonomous diving and steering of unmanned underwater vehicles. IEEE J. Ocean. Eng. 18(3), 327339 (1993)
3. Herman, P.: Decoupled PD set-point controller for underwater vehicles. Ocean Eng. 36(6), 529534 (2009)
4. Kim, M., Joe, H., Pyo, J., et al.: Variable-structure PID controller with Anti-windup for Autonomous underwater vehicle. OCEANS-San diego, 2013 MTS/IEEE
5. Yoerger, D., Slotine, J.: Robust trajectory control of underwater vehicles. IEEE J. Ocean. Eng. 10(4), 462470 (1985)
6. Bartolini, G., Punta, E.: Second order sliding mode tracking
control of underwater vehicles. In American Control Conference, 2000. Proceedings of the 2000; 1(6): 6569
7. Salgado-Jimenez, T., Jouvencel, B.: Using a high order sliding modes for diving control a torpedo autonomous underwater vehicle. In OCEANS 2003. Proceedings, 2, pp. 934
939.
8. Pisano, A., Usai, E.: Output-feedback control of an underwater vehicle prototype by higher-order sliding modes. Automatica 40(9), 15251531 (2004)
9. Roche, E., Sename, O., Simon, D.: LPV/H control of an
autonomous underwater vehicle (AUV). In: Proceedings of
the European Control Conference 2009; Budapest, Hungary
10. Feng, Z.P., Allen, R.: H autopilot design for autonomous
underwater vehicles. J. Shanghai Jiaotong Univ. (Science)
15(2), 194198 (2010)
11. Petrich, J., Stilwell, D.J.: Robust control for an autonomous
underwater vehicle that suppresses pitch and yaw coupling.
Ocean Eng. 38(1), 197204 (2011)
12. Sun, B., Zhu, D., Li, W.: An integrated backstepping and
sliding mode tracking control algorithm for unmanned
underwater vehicles. In Conference on Control (CONTROL), 2012 UKACC International
13. Zhu, D., Sun, B.: The bio-inspired model based hybrid
sliding-mode tracking control for unmanned underwater
vehicles. Eng. Appl. Artif. Intell. 26(10), 22602269 (2013)
14. Caccia, M., Veruggio, G.: Guidance and control of a reconfigurable unmanned underwater vehicle. Control Eng. Pract.
8(1), 2137 (2000)
15. Slotine, J.J.E., Li, W.: Applied Nonlinear Control. Prentice
Hall, Upper Saddle River (1991)
16. Utkin, V.I.: Sliding mode control design principles and
applications to electric drives. IEEE Trans. Ind. Electron.
40(1), 2336 (1993)
17. Polyakov, A., Poznyak, A.: Lyapunov function design for
finite-time convergence analysis: twisting controller for
second-order sliding mode realization. Automatica 45, 444
448 (2009)
18. Eker, I.: Second-order sliding mode control with experimental application. ISA trans. 49, 394405 (2010)
19. Chen, H., Sun, W.J., Sun, Z.D., Yeow, J.T.W.: Second-order
sliding mode control of a 2D torsional MEMS micromirror
with sidewall electrodes. J. Micromech. Microeng. 23, 19
(2013)
20. Lu, L., Yu, M., Luan, L.: Synchronization between uncertain
chaotic systems with a diverse structure based on a secondorder sliding mode control. Nonlinear Dyn. 70(3), 1861
1865 (2012)
21. Lu, L., Yu, M., Li, C., Liu, S., Yan, B., Chang, H., Zhao, J.,
Liu, Y.: Projective synchronization of a class of complex network based on high-order sliding mode control. Nonlinear
Dyn. 73, 16 (2013)
22. Bi, F.Y., Wei, Y.J., Zhang, J.Z., et al.: Position-tracking control of underactuated autonomous underwater vehicles in the
presence of unknown ocean currents. IET Control Theory
Appl. 4(11), 23692380 (2010)
23. Tong, S., Li, H.X.: Fuzzy adaptive sliding-mode control for
MIMO nonlinear systems. IEEE Trans. Fuzzy Syst. 11(3),
354360 (2003)
123
H. Joe et al.
24. Li, H.X., Tong, S.: A hybrid adaptive fuzzy control for a
class of nonlinear MIMO systems. IEEE Trans. Fuzzy Syst.
11(1), 2434 (2003)
25. Li, Y., Tong, S., Li, T.: Adaptive fuzzy output feedback control for a single-link flexible robot manipulator driven DC
123