Professional Documents
Culture Documents
I. INTRODUCTION
In motion control design, disturbance rejection and robustness to parametric uncertainties are important issues
besides tracking performance. Disturbance-observer-based
control is an effective method often used to deal with
these issues. Experimental results in [1][3] have shown
the effectiveness of disturbance-observer-based control. In
disturbance-observer-based control design, an inner disturbance observer loop is added into a main feedback control
loop. The key of the disturbance observer design is to select
a proper low-pass filter. The inner disturbance observer loop
has been studied by several researchers [3], [4]. Various
guidelines were suggested for the selection of the lowpass filter. These suggestions make the disturbance observer
loop behave more desirable. However, since the disturbance
observer loop is just a part of the overall closed loop
system, the robust stability of the closed loop system is
not guaranteed. In this paper, we present a design method
for the disturbance observer based on closed loop consideration. The resulting closed loop system satisfies given
specifications, which ensure desired disturbance attenuation
and robust stability.
The remainder of this paper is organized as follows.
Section II provides a brief overview of disturbance observers and certain fixed-structure disturbance observers.
Section III gives the problem statement of the disturbance
observer design based on closed loop consideration. The
problem is solved by the algorithm presented in Section IV.
C.-C. Wang and M. Tomizuka are with the Department of Mechanical
Engineering, University of California at Berkeley, Berkeley, CA 94720
USA (e-mail: ccwang@me.berkeley.edu; tomizuka@me.berkeley.edu).
This work was supported by FANUC Ltd.
(1)
where
Gyv (s) =
Gyd (s) =
Gy (s) =
P (s) Pn (s)
Pn (s) + Q (s) (P (s) Pn (s))
P (s) Pn (s) (1 Q (s))
Pn (s) + Q (s) (P (s) Pn (s))
P (s) Q (s)
Pn (s) + Q (s) (P (s) Pn (s))
(2)
(3)
(4)
3764
+
-
Fig. 1.
d = G1 (s) u + G2 (s) y
(11)
where
B. Fixed-structure Disturbance Observers
In the state estimator design, assuming that the disturbance model is available, the model can be included in the
estimator equations, and the disturbance can be estimated
along with the plant state [5]. Although the disturbance
is estimated under the assumption of known disturbance
modes, it has be shown that the augmented state estimator
is indeed a disturbance observer if the assumed disturbance
model includes modes 1/si , where i 1 [6].
It is assumed that the plant model Pn (s) is strictly proper
and does not have a zero at the origin. The state space
representation of Pn (s) is given by
x = A x + B (u + d)
y = Cx
(5)
= Ad xd
= Cd xd
(6)
(7)
"
A + L C
G1 (s) =
Cd
A =
A BCd
0 Ad
, B =
B
0
, C =
(8)
(9)
= A + L C z + B L
y
"
A + L C
; G2 (s) =
Cd
L
0
(12)
(13)
where
Q(s) =
Nr
1 + k=1
ak ( s)k
1 + Nk=1 ak ( s)k
(14)
(15)
3765
+
_
+
_
+
-
(16)
Pn (s) (1 Q (s))
Pn (s)C (s)
r+
d
1 + Pn (s)C (s)
1 + Pn (s)C (s)
Pn (s)C (s) + Q (s)
+
1 + Pn (s)C (s)
(17)
(19)
(20)
(21)
(1
Q(s))
1 + Pn (s)C(s)
s = j
(24)
(25)
(26)
3766
(27)
A B 0 I
Pobs (s) = Cd 0 0 0
(28)
C
+
+
0 I 0
Design Procedure:
1) Design the feedback controller C(s) based on the
nominal model Pn (s), focusing on the tracking performance.
2) Select weighting functions Wp (s) and Wu (s).
3) Determine the disturbance model (6). The simplest
choice of the pair (Ad ,Cd ) is (Ad = 0, Cd = 1), i.e.
assume that the disturbance model is 1/s. If any
disturbance mode is explicitly known, it can also be
included in the disturbance model.
4) Construct the extended plant PL (s) as shown in Fig.
3(b). Use the algorithm provided in the next section
to find the gain L.
5) If the gain L can not be found, increase the order of
the disturbance model and/or relax the specifications
of the closed loop system. Go to step 4).
IV. H OPTIMIZATION ALGORITHM FOR
SEARCHING GAIN L
Define the state space realization of PL (s) as:
BL1
BL2
AL
PL (s) = CL1
DL11 DL12
CL2
DL21 DL22
(29)
output feedback gain L such that kFL (PL (s), L)k < for
given > 0 [8].
Theorem 1: There exists a gain L such that
kFL (PL (s), L)k < if and only if there exist two
symmetric matrices X RnL nL and Y RnL nL such that
T
T AL X + XATL XCL1
BL1
N1 0
N 0
CL1 X
I DL11 1
0 (30)
0 I
0 I
BTL1
DTL11 I
T
T ATL Y +YAL Y BL1 CL1
N2 0
N2 0
0 (31)
BTL1Y
I DTL11
0 I
0 I
CL1
DL11 I
X I
0 (32)
I Y
rank (XY I) = 0 (33)
where
T N1T and N2 denote bases of the null spaces of
BL2 DL12 and CL2 DL21 , respectively.
X,Y RnL nL
tr(XY ) = nL
(34)
This is not a convex optimization problem, since the objective function in (34) is not a convex function of both X
and Y . As suggested in [9], we use the cone complementarity linearization algorithm [10] to solve the minimization
problem. It starts with linearizing the objective function
with respect to X and Y . The minimization problem (34)
becomes
min tr(Xk+1Yk + XkYk+1 )
Xk+1 ,Yk+1
3767
Y BL2
+ 0 L CL2 DL21 0 0
DL12
(36)
V. EXAMPLE
This section provides an example to illustrate the design
method for the disturbance observer. We consider trackfollowing control of a hard disk drive. The goal of trackfollowing control is to maintain the read/write head on
the track in the presence of external disturbances. The
controlled plant is modelled as follows [11].
2
2
K n1
n2
0.5TD s + 1
P(s) = 2
2
2
2
s + 21 n1 s + n1 s + 22 n2 s + n2 0.5TD s + 1
(37)
The first term represents the low frequency dynamics, while
the second and last term represent a structural resonant
mode and Pade approximation of time delay, respectively.
The bode plot of P(s) is shown in Fig 4. The resonant mode
appears at 3.6 kHz. The nominal model Pn (s) is chosen as
(38), ignoring the resonant mode and time delay.
Pn (s) =
2
K n1
2
1 n1 s + n1
s2 + 2
(38)
Q2 (s) =
3 s + 1
3 s3 + 3 2 s2 + 3 s + 1
(43)
3768
Bode Diagram
50
Magnitude (dB)
P(s)
100
150
P (s)
n
200
I A + BDcC BCc
0
BCd
I Ac
0
0
Bc C
det
BDcC + L1C BCc I A L1C
0
L2C
0
L2C
I Ad
I A + BDcC BCc
0
BCd
I Ac
0
0
Bc C
= det
0
0
I A L1C BCd
0
0
L2C
I Ad
I A + BDcC BCc
I A L1C BCd
det
= det
Bc C
I Ac
I Ad
L2C
(45)
R EFERENCES
[1] T. Umeno and Y. Hori, Robust speed control of DC servomotors using modern two degrees-of-freedom controller design, IEEE
Transactions on Industrial Electronics, vol. 38, pp. 363368, October
1991.
[2] H. S. Lee and M. Tomizuka, Robust motion controller design for
high-accuracy positioning systems, IEEE Transactions on Industrial
Electronics, vol. 43, pp. 4855, February 1996.
[3] S. Endo, H. Kobayashi, C. J. Kempf, S. Kobayashi, M. Tomizuka,
and Y. Hori, Robust digital tracking controller design for high-speed
positioning systems, Control Engineering Practice, vol. 4, no. 4,
pp. 527536, 1996.
[4] Y. Choi, K. Yang, W. K. Chung, H. R. Kim, and I. H. Suh, On
the robustness and performance of disturbance observers for secondorder systems, IEEE Transactions on Automatic Control, vol. 48,
pp. 315320, February 2003.
[5] G. F. Franklin, J. D. Powell, and M. Workman, Digital control of
dynamic systems. Addison Wesley, third ed., 1997.
[6] E. Schrijver and J. Van Dijk, Distrubance observers for rigid mechanical systems: equivalence, stability, and design, ASME Journal
of Dynamic Systems, Measurement, and Control, vol. 124, pp. 539
548, December 2002.
Phase (deg)
90
180
270
360
450
540
2
10
10
10
10
Frequency (rad/sec)
Fig. 4.
20
10
0
1
| (j)|
10
20
Magnitude (dB)
APPENDIX
Ac Bc
stabilizes Pn (s) =
Assume that C(s) =
Cc Dc
A B
A BDcC BCc
, (i.e.
is Hurwitz), and L =
BcC
Ac
C 0
T T T
is chosen so that
L1 L2
the estimator (9) is stable (i.e.
A
+
L
C
BC
1
d
A + LC =
is Hurwitz). The A matrix
L2C
Ad
of the closed loop system with C(s) and the disturbance
observer is given by
A BDcC BCc
0
BCd
BcC
Ac
0
0
(44)
Aclosed =
BDcC L1C BCc A + L1C
0
L2C
0
L2C
Ad
DOB2
30
1
|Wu (j)|
40
DOB1
50
60
70
80
2
10
10
10
10
10
Frequency (rad/sec)
3769