Professional Documents
Culture Documents
Abstract
The development of a novel adaptive autopilot for the dive-plane control of multi-input multi-output submarines with
unmodeled dynamics, based on the L1 adaptive control theory, is the subject of this article. An L1 adaptive autopilot is
designed for the trajectory control of the depth and pitch angle using bow and stern hydroplanes. Interestingly, the
structure of the adaptive controller remains fixed, regardless of the nonlinearities and external disturbance inputs,
retained in the model of the submarine. Unlike the traditional adaptive control laws, the L1 adaptive control input is generated by filtering the estimated control signal. A nice feature of the control law is that it is possible to achieve fast adaptation and desirable performance bounds in the closed-loop system by the choice of large adaptation gains. Simulation
results are presented, which show that the autopilot accomplishes precise trajectory control in the dive plane, despite
parametric uncertainties, unmodeled nonlinearities, and random disturbance inputs.
Keywords
L1 adaptive submarine control, autonomous underwater vehicle dive-plane control, nonlinear submarine control, uncertain autonomous underwater vehicle control, multi-input control
Introduction
The design of control systems for high-performance
autonomous underwater vehicles (AUVs), which are
capable of executing precise maneuvers, is an important
problem from the theoretical as well as practical point
of view. But the design of autopilots for AUVs is indeed
challenging. The complexity in the design is caused by
the nonlinear dynamics of AUVs. Also, the control system must attenuate the effect of disturbance forces and
moments due to sea waves.
Researchers have made significant progress in
exploring the nonlinear dynamical behavior of submersibles and designing feedback control systems for performing maneuvers. Based on modern control
techniques, linear and nonlinear control systems have
been proposed for AUVs.1 The design of autopilot for
lateral control has been presented based on H# control
method. An application of the multi-input multi-output
(MIMO) H control design technique for the robust
control of an AUV that suppresses pitch and yaw coupling has been provided.3 A suboptimal control law for
the dive-plane control of an AUV has been derived
using the state-dependent Riccati equation method.4
331
332
Submarine model
For this study, the dive-plane nonlinear time-varying
dynamics of submarines (as shown in Figure 1) are considered. This model is similar to the neutrally buoyant
_ =
w(t)
and
M9u_ U _
M9w U
_ = M9w_ w(t)
_ + 2
u(t)
w(t) +
Q(t)
L I92
LI92
LI92
M9dB U2
M9dS U2
+
dB(t)
+
dS(t)
L2 I92
L2 I92
2mg(zG zB )
Md (t)
+
u(t) +
+ Mn (w, q)
rL5 I92
0:5rL5 I92
2
333
and control inputs can be completed following the derivation of Hovakimyan and Cao.31)
In view of the interest in the depth trajectory control,
where uc = (dB, dS)T 2 R2 is the control input vector, it will be convenient to consider the design problem in
and the state space of variables h, u, h,
and
the
nonlinear
functions
(fw , fu )
_ and Q,
_ instead of w,
B0 = BT01 , BT02 T 2 R2 3 2 are given by
_ Differentiating equation (5) gives
_ and Q.
u, w,
2
3
Z9w U
_ + Zd (t)
w(t) + m91 3 (Z9u_ + m9)Uu(t)
3 m9 + Zn (w, q)
fw (w, u, Q, t)
Lm9
0:5rL
3
3
5
= M1 4
M9u_ U _
2mg(zG zB )
Md (t)
M9w U
fu (w, u, Q, t)
u(t)
+
w(t)
+
u(t)
+
+
M
(w,
q)
5
5
2
n
LI92
rL I92
0:5rL I92
L I92
2
3
"
#
Z9dS U2
Z9dB U2
1
ZQ9
_ L=m93
m9 L
m93 L 5
M=
4
; B0 = M1 4 3 2
2
1
M9
M9
U
dS U
dB
Mw9
1
_ (LI92 )
2
2
L I9
L I9
3
where hr (t) and ur (t) are certain smooth depth and pitch
angle trajectories. The objective here is to design an L1
adaptive control law so that the submarine follows the
given reference depth command hr (t) and attains the
specified depth, and furthermore, the deviation in the
pitch angle remains small around the commanded null
trajectory ur (t) = 0 for all t 5 0 despite parametric
uncertainties, unmodeled nonlinearities, and random
disturbance inputs.
11
U0 Q cos u
Note that w from equation (9) is substituted in equation (11) to obtain gh and gu in equation (10).
_ Q)T 2 R4 . Then
Define a state vector as x = (h, u, h,
a state variable representation of the AUV obtained
from equation (10) is given by
2
3
2
3
h_
02 3 2
6
7
Q
7 4
5
12
x_ = 6
4 gh (u, h,
_ Q, t) 5 + B01 cos u uc
B
02
_ Q, t)
gu (u, h,
where the null matrix 02 3 2 has two rows and two columns. The controlled output vector is
y = I2 3 2 , 02 3 2 x = C0 x
13
334
B01 cos u of uc is replaced by B01 . With this simplification, equation (12) can be written as
02 3 2 I 2 3 2
02 3 2
_ Q, t) + B0 uc )
x_ =
x+
(g(u, h,
02 3 2 02 3 2
I2 3 2
14
_ Q, t) is an unmodeled vector
It is assumed that g(u, h,
function. For the design of the controller, the uncertain
input matrix is assumed to be of the form
B0 = B0m V; V = diagfv11 , v22 g
15
where zi . 0 and vi . 0 are design parameters. By adding and subtracting Am1 , Am2 x, equation (14) can be
expressed as
x_ =Am x+ Bm
h
i
T
_ T
_
Vuc + B1
0m fAm1 (h, u) Am2 (h,Q) +g(u, h, Q, t)g
:
Am x+ Bm Vuc +f(x,t)
17
18
19
Figure 2. A block diagram representation of the closed-loop system including the L1 adaptive autopilot.
335
presented. First, in view of the equivalent system equation (19), consider a state predictor of the form
^ c +m
^ (t)jjx(t)jj + s
^ (t), x^(0) = x(0)
x^_ = Am x^ + Bm Vu
20
21
where V~ = V^ V, m
~ =m
^ m, and s
~ =s
^ s are the
parameter and function errors.
For the derivation of the adaptation law, consider a
quadratic positive definite Lyapunov function
~ +m
~ m
~ Tm
W(~
x, V,
~, s
~ ) = x~T P~
x + G1 tr(V~T V)
~ +s
~Ts
~
22
23
24
1
2G ~
mT m_ + s
~ T s
_
^ c +m
uc = Kf D(s)V(t)u
^ (t)jjx(t)jj
+s
^ Kg yr (t), uc (0) = 0
27
28
1
is stable and K1
g = C0 Am Bm . Here, s denotes the
Laplace variable or a differential operator. Suppose the
initial conditions satisfy jjx0 jj 4 r0 . Then there exists
rin . r0 such that
29
30
25
26
336
where
c
4 p p
(p) =
p
e pm
31
where g 1 and g 2 are computable bounds. (For a complete derivation, readers may refer to Hovakimyan and
Cao.31) Interestingly, it has been established that the
tracking error between y(t) and yref (t), and uc (t) and
ucref (t), is uniformly
p bounded by a constant inversely
proportional to G. Therefore, it is possible to achieve
desirable tracking transient and steady-state performance by the choice of large adaptation gains. It is
pointed out that such kind of performance bounds cannot be obtained using traditional adaptive laws.
For the AUV model, the matrix D(s) is selected as
D = s1 I2 3 2 and the feedback matrix is set to
Kf = kf I2 3 2 for simplicity, where kf is a positive real
number. Then the control law equation (27) simplifies to
^ c+m
^ jjx(t)jj + s
^ Kg yr , uc (0) = 0 32
u_ c = kf Vu
This completes the design.
Simulation results
This section presents the simulation results. The complete closed-loop system including the submarine model
equations (1) and (2), adaptation law (equation (25)),
and the control law (equation (32)) is simulated. The
parameters of the model given in Dumlu and
Istefanopulos27 are used for simulation. (These are collected in Appendix 1 for convenience.) Of course, here
results for the model including nonlinear terms will also
be obtained. The initial state of the vehicle is x(0) = 0.
Numerical results for various cases for the model
including random disturbances, unmodeled nonlinearities, and parameter uncertainties are obtained. A
smooth projection algorithm is used for updating the
^ i , and s
^ i , (i = 1, 2). Suppose a paraparameters v^ii , m
meter p is to be confined to a set P defined by
P = fp : jp pj \ pm g
if c(p) 4 0
if c(p) 5 0 and
c
p (p)f 4 0
33
if not
1.
337
Figure 3. Adaptive control: hr = 10 ft, uncertainty factor au = 1:6, disturbance Zd = 0 and Md = 0: (a) depth h; (b) heave velocity w;
(c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter estimate m
^1, m
^ 2 ; and
(h) parameter estimate s
^1 , s
^2.
338
Ts (s)
ucm ()
um
0.1
1
10
100
500
800
1000
5000
120.2224
120.3567
120.3032
120.3046
120.3007
120.2999
120.2985
98.3757
(30.0000, 30.0000)
(14.8440, 5.8910)
(9.6143, 1.2550)
(9.6133, 1.2527)
(9.6134, 1.2524)
(9.6133, 1.2523)
(9.6232, 1.2490)
(13.9122, 2.0753)
0.3406
0.0140
0.0028
0.0029
0.0029
0.0029
0.0029
0.0006
()
339
Figure 4. Adaptive control: hr = 10 ft, uncertainty factor au = 0:4, random disturbance Zd and Md : (a) depth h; (b) heave velocity w;
(c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter estimate m
^1, m
^ 2;
^ 2 ; (i) disturbance Zd ; and (j) disturbance Md .
(h) parameter estimate s
^1 , s
340
Figure 5. Adaptive control: hr = 10 ft, uncertainty factor au = 1:6, random disturbance Zd and Md : (a) depth h; (b) heave velocity w;
(c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter estimate m
^1, m
^ 2 ; and
(h) parameter estimate s
^1 , s
^2.
341
Figure 6. Adaptive control: hr = 10 ft, uncertainty factor au = 1:6, random Zd and Md , unmodeled nonlinearities (Zn , Mn ): (a) depth
h; (b) heave velocity w; (c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter
estimate m
^1, m
^ 2 ; and (h) parameter estimate s
^1 , s
^2 .
Table 2. Effect of control saturation: hr : hr = 50, 60, 70, 90, au = 1:6, Zd = 0, Md = 0.
Depth command hr (ft)
vi
Ts (s)
ucm ()
um ()
50
60
70
90
0.08
0.07
0.06
0.05
149.5369
170.9839
200.3521
240.2922
(30.0000, 7.9188)
(30.0000, 7.7124)
(30.0000, 2.9597)
(30.0000, 3.7158)
0.5866
0.6561
0.1555
0.3222
342
Figure 7. Adaptive control: hr = 30 ft, uncertainty factor au = 1:6, disturbance Zd = 0, Md = 0: (a) depth h; (b) heave velocity w;
(c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter estimate m
^1, m
^ 2 ; and
(h) parameter estimate s
^1 , s
^2.
Ts (s)
ucm ()
um ()
10
20
30
120.2985
120.2975
120.2977
(9.6232, 1.2490)
(19.2265, 2.5046)
(28.8696, 3.7466)
0.0029
0.0058
0.0087
343
Figure 8. Adaptive control: hr = 30 ft, uncertainty factor au = 1:6, random disturbance Zd and Md : (a) depth h; (b) heave velocity w;
(c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter estimate m
^1, m
^ 2 ; and
^2.
(h) parameter estimate s
^1 , s
Ts (s)
ucm ()
um ()
1.8
1.6
1.4
1.2
0.8
0.6
0.4
0.3
0.2
120.3012
120.2977
120.2943
120.2907
120.2837
120.2804
120.2769
120.2766
120.2747
(28.8747, 3.7659)
(28,8696, 3.7466)
(28.8050, 3.7475)
(28.7705, 3.7385)
(28.7022, 3.7206)
(28.6687, 3.7117)
(28.6360, 3.7036)
(28.6205, 3.6997)
(28.6087, 6.6375)
0.0097
0.0081
0.0076
0.0065
0.0043
0.0032
0.0021
0.0016
0.0011
344
Figure 9. Adaptive control: hr = 30 ft, uncertainty factor au = 1:6, random Zd and Md , unmodeled nonlinearity (Zn , Mn ): (a) depth h;
(b) heave velocity w; (c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter
estimate m
^1, m
^ 2 ; and (h) parameter estimate s
^1 , s
^2 .
Ts (s)
ucm ()
um ()
Case 6 (paper)
53 Case 6
103 Case 6
120.2393
120.0490
NC
(30.0000, 5.9972)
(30.0000, 22.6765)
NC
0.0117
0.1136
NC
are acting on the vehicle. For this purpose, the disturbance inputs used in Case 2 are amplified by a factor of
5 or 10. It is seen that although the controller succeeds
345
Figure 10. Adaptive control: effect of control saturation, hr = 60 ft, uncertainty factor au = 1:6, (Zn , Mn ): (a) depth h; (b) heave
^ 1,
velocity w; (c) pitch rate Q; (d) pitch angle u; (e) control signal uc (dB, dS); (f) parameter estimate ^v11 , ^v22 ; (g) parameter estimate m
m
^ 2 ; and (h) parameter estimate s
^1 , s
^2.
depend on the effectiveness of the hydroplanes in producing the control forces and moments.
To this end, it is appropriate to provide a comparison of the adaptive control systems and the reconfiguring VSC system published for this submarine model.
For the model without hydrodynamic nonlinearities,
the sliding mode controller of Demirci and
Kerestecioglu,28 the adaptive controller of Nambisan
and Singh,29 the noncertainty-equivalent adaptive system of Lee and Singh,30 and L1 adaptive autopilot have
somewhat similar response characteristics. Each of
these controllers accomplishes depth and pitch angle
control. But it is important to note that unlike the L1
346
3.
4.
5.
6.
7.
8.
9.
10.
Conclusion
In this article, the dive-plane control of MIMO submarine model including time-varying unmodeled dynamics,
based on the L1 adaptive control theory, was considered. An L1 adaptive law was designed for the trajectory control of the depth and pitch angle. Interestingly,
unlike the traditional adaptive laws, the L1 autopilot
provides flexibility in the selection of large adaptation
gains for fast adaptation and achieving desirable transient and steady-state performance bounds. Simulation
results showed that the designed L1 adaptive controller
accomplished the specified dive-plane maneuvers
despite large parameter uncertainties, unmodeled nonlinearities, and disturbance inputs.
11.
12.
13.
14.
15.
16.
17.
This research received no specific grant from any funding agency in the public, commercial, or not-for-profit
sectors.
18.
19.
References
1. Fossen TI. Guidance and control of ocean vehicles. New
York: Wiley Publications, 1994.
2. You SS, Lim TW and Jeong SK. General path-following
maneuvers for an underwater vehicle using robust con-
20.
trol synthesis. Proc IMechE, Part I: J Systems and Control Engineering 2010; 224: 960969.
Petrich J and Stilwell DJ. Robust control for an autonomous underwater vehicle that suppresses pitch and yaw
coupling. Ocean Eng 2011; 38(1): 197204.
Naik MS and Singh SN. State-dependent Riccati
equation-based robust dive plane control of AUV with
control constraints. Ocean Eng 2007; 34: 17111723.
Chin CS, Lau MWS, Low E, et al. Robust and
decoupled cascaded control system of underwater robotic
vehicle for stabilization and pipeline tracking. Proc
IMechE, Part I: J Systems and Control Engineering 2008;
222(4): 261278.
Lau MWS, Swei SSM, Seet G, et al. Control of an
underactuated remotely operated underwater vehicle.
Proc IMechE, Part I: J Systems and Control Engineering
2003; 217(5): 343358.
Healey AJ and Lienard D. Multivariable sliding mode
control for autonomous diving and steering of unmanned
underwater vehicles. IEEE J Oceanic Eng 1993; 18(3):
327339.
Yoerger DR and Slotine JE. Robust trajectory control of
underwater vehicles. IEEE J Oceanic Eng 1985; 10(4):
462470.
Chin CS and Lum SH. Rapid modeling and control systems prototyping of a marine robotic vehicle with model
uncertainties using xPC target system. Ocean Eng 2011;
38: 21282141.
Soylu S, Buckham BJ and Podhorodeski RP. A
chattering-free sliding-mode controller for underwater
vehicles with fault-tolerant infinity-norm thrust allocation. Ocean Eng 2008; 35(16): 16471659.
Ishaque K, Abdullah SS, Ayob SM, et al. A simplified
approach to design fuzzy logic controller for an underwater vehicle. Ocean Eng 2011; 38(1): 271284.
Levedahl BA and Silverberg L. Control of underwater
vehicles in full unsteady flow. IEEE J Oceanic Eng 2009;
34(4): 656668.
Do KD, Pan J and Jiang ZP. Robust and adaptive path
following for underactuated autonomous underwater
vehicles. Ocean Eng 2004; 31(16): 19671997.
Li J and Lee P. Design of an adaptive nonlinear controller for depth control of an autonomous underwater vehicle. Ocean Eng 2005; 32(1718): 21652181.
Lapierre L and Jouvencel B. Robust nonlinear pathfollowing control of an AUV. IEEE J Oceanic Eng 2008;
33(2): 89102.
Trebi-Ollennu A and White BA. Non-linear robust control designs for a remotely operated underwater vehicle
depth control system. Proc IMechE, Part I: J Systems
and Control Engineering 1996; 210(3): 201214.
Ishii K, Fujii T and Ura T. An on-line adaptation method
in a neural network based control system for AUVs.
IEEE J Oceanic Eng 1995; 20(3): 221228.
Zhang M-J and Chu Z-Z. Adaptive sliding mode control
based on local recurrent neural networks for underwater
robot. Ocean Eng 2012; 45: 5662.
Zhang L-J, Qi X and Pang Y-J. Adaptive output feedback control based on DRFNN for AUV. Ocean Eng
2009; 36: 716722.
Wang J-S and Lee CSG. Self-adaptive recurrent neurofuzzy control of an autonomous underwater vehicle.
IEEE T Robotic Autom 2003; 19(2): 283295.
347
28. Demirci U and Kerestecioglu F. A re-configuring slidingmode controller with adjustable robustness. Ocean Eng
2004; 31(13): 16691682.
29. Nambisan PR and Singh SN. Multi-variable adaptive
back-stepping control of submersibles using SDU decomposition. Ocean Eng 2009; 36(2): 158167.
30. Lee KW and Singh SN. Noncertainty-equivalent multivariable adaptive control of submersibles using filtered
signals. Ocean Eng 2012; 53: 98110.
31. Hovakimyan N and Cao C. Adaptive control theory: guaranteed robustness with fast adaptation. Philadelphia, PA:
SIAM, 2010, pp.94105.
32. Cao C and Hovakimyan N. L1 adaptive controller for
nonlinear systems in the presence of unmodelled
dynamics: part II. In: Proceedings of American control
conference, Seattle, WA, 1113 June 2008, pp.40994104.
New York: IEEE.
33. Gregory IM, Cao C, Xargay E, et al. L1 adaptive control
design for NASA AirSTAR flight test vehicle. In: AIAA
guidance, navigation and control conference, Chicago, IL,
1013 August 2009, AIAA-2009-5738. Reston, VA:
AIAA.
34. Pomet J-B and Praly L. Adaptive nonlinear regulation:
estimation from the Lyapunov equation. IEEE T Automat Contr 1992; 37(6): 729740.
Appendix 1
Hydrodynamic coefficients27,28
Parameter value
Parameter value
Parameter value
Z9w = 0:0110
Z9u = 0:0002
M9w = 0:0030
M9u = 0:0004
I9y = 5:68673104
ZG ZB = 1:5 ft
I92 = I9y M9u
Z9w_ = 0:0075
Z9dB = 0:0025
M9w_ = 0:0002
M9dB = 0:0005
L = 286 ft
U = 8:43 ft=s
m9 = 2m=(rL3 )
Z9u_ = 0:0045
Z9dS = 0:0050
M9u_ = 0:0025
M9dS = 0:0025
m = 1:523105 slug
r = 2:0 slug=ft3
m93 = m9 Z9w_