Professional Documents
Culture Documents
An Analysis of Parameter Variations of Disturbance Observe
An Analysis of Parameter Variations of Disturbance Observe
6, DECEMBER 2007
3413
I. I NTRODUCTION
Manuscript received March 1, 2006; revised July 10, 2007. This work was
supported by the Ministry of Education, Culture, Sports, Science and Technology of Japan under Grant-in-Aid for Scientific Research (A), 17206027, 2005.
This paper was presented in part at the 31st IEEE Annual Conference of the
IEEE Industrial Electronics Society, Raleigh, USA, November 6-10, 2005.
H. Kobayashi is with the System Development Laboratory, Hitachi, Ltd.,
Yokohama 244-0817, Japan (e-mail: hide@2005.jukuin.keio.ac.jp).
S. Katsura is with the Department of Electrical Engineering, Nagaoka
University of Technology, Nagaoka 940-2188, Japan (e-mail: katsura@vos.
nagaokaut.ac.jp).
K. Ohnishi is with the Department of System Design Engineering, Keio
University, Yokohama 223-8522, Japan (e-mail: ohnishi@sd.keio.ac.jp).
Color versions of one or more of the figures in this paper are available online
at http://ieeexplore.ieee.org.
Digital Object Identifier 10.1109/TIE.2007.905948
In order to stably contact with the environment, many researches have been developed. The basic strategy to contact
with the environment is stiffness control [1], which corresponds
to proportional-derivative control with gravity compensation.
Active compliance can be provided by using either hybrid
position/force control [2] or impedance control [3][5]. Contact
transition control via acceleration feedback [6] and neural network control scheme for force control [7] have been proposed.
In this way, many researchers have paid attention to develop
novel force control architectures.
The ability which is requested of machines is changing
recently. In the past, machines only worked in closed environments such as a factory or plant. However, recent machines are
being planned to work in an open environment, which dynamically changes. In order to make machines that are able to work
in such environments, haptics is the key technology in addition
to vision and speech. Haptics is a technology for touching an
object. Teleoperation [8][12] and virtual reality [13] are some
of the expected applications of haptics. Shimono et al. [14]
proposed the haptic database based on bilateral control. The
proposed control system abstracts the haptic information of an
environment and reproduces the haptic information bilaterally.
Katsura and Ohnishi [15] proposed the haptic training system
by multilateral control. It attains the law of action and reaction by three remote robots and realizes the haptic training
system.
The robustness of motion systems is essential to attain such
high performance as the haptic motion control. A good candidate for the attainment of robust control is a disturbance
observer [16], [17]. Disturbance observer is a basic technology
for the disturbance suppression and the attainment of robust
acceleration control. The disturbance observer identifies the
total mechanical load torque and parameter variations. The
parameter variations are the inertia variation and the variation
of torque coefficient. The feedback of the estimated disturbances makes the control system nominal. Conventionally, the
nominal values of inertia and torque coefficients are designed
not as control parameters but the same values as the actual
ones. However, the disturbance observer is able to include
the effect of phase compensation by properly selecting the
nominal model parameters. Compared with implementing a
conventional phase lead-lag compensator, the control system
is simple and easy to design. Katsura and Ohnishi [18] proposed the absolute stabilization of a multimass resonant system
by phase compensation based on disturbance observer. The
proposed control focuses on nominal inertia and attains the
phase lead compensation by properly selecting the nominal
inertia.
3414
In this paper, the nominal model parameters are actively designed to achieve the phase compensation. This paper proposes
the design method of observer to achieve phase compensation
based on disturbance observer. The selection of these nominal
model parameters has some restriction. When the nominal
model parameters are much separated from the actual ones,
the stability of the control system deteriorates. Murakami and
Ohnishi [19] researched the stability of a position control
system when the nominal inertia changes. Bertoluzzo et al. [20]
also researched the stability in discrete-time system. However,
these researches did not focus on the bandwidth for disturbance
suppression. It is commonly misconceived that the bandwidth
for disturbance suppression is equal to the cutoff frequency of
disturbance observer. The main contribution of this paper is to
show that the bandwidth for disturbance suppression depends
not only on the cutoff frequency of disturbance observer but
also on the parameter variations. The bandwidth for disturbance
suppression should be fixed when the nominal model parameters are actively designed. The stability under the parameter
variations should also be analyzed with the bandwidth for
disturbance suppression fixed. Since the variation of torque
coefficient is small, this paper focuses on the inertia variation
and neglects the variation of torque coefficient. Furthermore,
the stability of position control system and force control system
is analyzed.
This paper is organized as follows. In the following section,
control stiffness and disturbance observer are introduced as
basic skills of motion control. In this section, it will be shown
that the cutoff frequency of disturbance suppression depends
on the parameter variations. This is the main contribution of this
paper. It will also be shown that a disturbance observer includes
the effect of phase compensation. In Section III, the method
to design the cutoff frequency of the disturbance observer and
reaction torque observer is proposed. In the proposed design
method, the nominal model parameters are actively chosen
to achieve the phase compensation based on the disturbance
observer. When the nominal model parameters are much
separated from the actual ones, the stability of the control system deteriorates. The stability of position and force
control systems is analyzed in Section IV. Then, the validity of the proposed design method and the effect of
phase compensation are verified by some experimental results
shown in Section V. Finally, this paper is summarized in
Section VI.
f
x
(1)
x
=
(2)
(3)
where x
denotes acceleration, and m denotes mass. Therefore, the acceleration controller is able to uniformly deal with
the position and force controls. In robust motion control, the
acceleration reference generator makes the acceleration reference value for the attainment of desired control stiffness.
The acceleration reference value is accurately attained by the
acceleration controller. Finally, the desired control stiffness is
achieved.
B. Acceleration Control by Disturbance Observer
A disturbance observer, which was proposed by Ohishi et al.
[16], [17], is a good candidate for an acceleration controller. A
disturbance observer identifies the total mechanical load torque
and parameter changes. In other words, the identification of
disturbance torque is essential for motion control robustness to
realize various applications. This section introduces the disturbance observer as an acceleration controller. The disturbance
observer is designed to cancel the disturbance torque as quickly
as possible.
The dynamic equation of motion system is represented as
follows:
J
d
= a l
dt
a = Kt Ia
(4)
(5)
KOBAYASHI et al.: ANALYSIS OF PARAMETER VARIATIONS OF DISTURBANCE OBSERVER FOR MOTION CONTROL
3415
where
J
inertia;
a generated torque;
load torque;
l
Kt torque coefficient of electric motor;
Ia torque current.
The parameters in (4) and (5) are inertia and torque coefficient. The inertia will change according to the mechanical
configuration of motion system. The torque coefficient will vary
according to the rotor position of electric motor due to irregular
distribution of magnetic flux on the surface of rotor
J = Jn + J
Kt = Ktn + Kt
(6)
(7)
where
nominal inertia;
Jn
J
inertia variation;
Ktn nominal torque coefficient;
Kt variation of torque coefficient.
By substituting (6) and (7) into (4) and (5), the following
equation is obtained:
Jn res = Ktn Ia dis .
(8)
(9)
= J res Kt Ia + l
(10)
l = Fc + Dres + reac .
(11)
In (9), the first term is the torque pulsations due to the inertia
variation. The second term is the torque pulsations due to
the variation of torque coefficient. The third and fourth terms
denote the Coulomb and the viscous friction, respectively. The
last term is the reaction torque caused by external torque.
Equation (8) can be transformed into
dis = Ktn Ia Jn res .
(12)
gdis
dis
s + gdis
(13)
Jn ref
.
Ktn
(14)
gdis
=
s + gdis
(15)
Kt Jn
gdis = gdis
Ktn J
(16)
Kt Jn
.
Ktn J
(17)
Gs represents a sensitivity showing how the load torque influences the motion system and is called a sensitivity function. As
shown in (16), the cutoff frequency of disturbance suppression
s + gdis
s + gdis
phase lag.
(18)
3416
phase lead
0 < Jn < J
phase lag.
greac
reac
s + greac
gdis
=G
where G is constant.
Second, the cutoff frequency of torque estimation greac is
set to the same value as the cutoff frequency of disturbance
suppression
greac = G.
(22)
(20)
, the
Unlike the cutoff frequency of disturbance suppression gdis
cutoff frequency of torque estimation greac does not depend on
other parameters.
In this paper, the reaction torque observer is selected to detect
the reaction torque from environment. Although a force sensor
is generally utilized to detect the reaction force, a force sensor
has so many problems. Since a force sensor detects the strain
of a strain gauge, it is difficult to detect the reaction force
when the environment is distorted at the time of contact [24].
(21)
gdis =
J
1
G = G.
Jn
(24)
=
gdis
(25)
KOBAYASHI et al.: ANALYSIS OF PARAMETER VARIATIONS OF DISTURBANCE OBSERVER FOR MOTION CONTROL
Fig. 4.
3417
Bode diagram of phase compensation. (a) Phase lead (G = 500, = 2). (b) Phase lag (G = 500, = 0.5).
TABLE I
PARAMETERS FOR STABILITY ANALYSIS
) (Kp + Kv s)
(s + gdis
res
= 2
) (K + K s) .
cmd
s (s + gdis ) + (s + gdis
p
v
(26)
s(Kv s + Kp )
s2 + K g s + K g = 0.
s3 + gdis
v dis
p dis
(27)
(28)
(29)
This result shows that the system is constantly stable even if the
nominal inertia is much separated from the actual one.
B. Force Control System
The block diagram of force control system is shown in
Fig. 7. When a machine contacts with the environment, the
reaction torque loop appears in a control system. The reaction
torque loop disappears when the machine gets away from the
environment. Generally, the environment is represented as a
spring and damper model
Zenv = Kenv + Denv s
(30)
3418
Fig. 8.
(37)
(38)
where
Zenv
Kenv
Denv
environmental impedance;
spring coefficient;
viscosity coefficient.
D1 (s)
(31)
where
N1 (s) = C
(32)
f J 2(s + gdis ) (Kenv + Denv s)(s +
greac )
D1 (s) = Js (s + gdis ) + s(Kenv + Denv s) (s + greac )
N2 (s)
=0
D2 (s)
(34)
2
D2 (s) = Js + (Jgdis + Denv ) s + Kenv s
(39)
(40)
(41)
(36)
V. E XPERIMENT
In this section, the validity of the proposed design method
and the effect of phase compensation are demonstrated by some
experimental results. First, it is verified from the results of
the position control system that the bandwidth for disturbance
suppression depends on parameter variation, as shown in (16).
Second, the effect of phase compensation is verified from the
results of the force control system.
A. Experimental Setup
Experiment is performed with a rotational manipulator
shown in Fig. 9. The overview of experiment setup is shown in
Fig. 10. Actuator is an ac servomotor that is made in Yaskawa
Electric Corporation. The power amplifier is II series. The
specifications of the ac motor are shown in Table II. Position
response is measured by the encoder. Velocity response is
calculated by the differentiation of position response through
the first-order low-pass filter
res =
gpd
sres
s + gpd
(42)
KOBAYASHI et al.: ANALYSIS OF PARAMETER VARIATIONS OF DISTURBANCE OBSERVER FOR MOTION CONTROL
Fig. 9.
TABLE III
PARAMETERS FOR EXPERIMENT
3419
why the responses of (a) and (c) got worse is related to the
bandwidth. Since the bandwidth for disturbance suppression is
represented as (16), the bandwidth of (a) is smaller than that
of (b). In addition, the bandwidth of (c) is larger than that of
(b). Hence, the response of (a) has an overshoot and longer
settling time. The response of (c) includes some noise. On the
other hand, Fig. 11(d)(f) shows the position responses when
the cutoff frequency of the disturbance observer is set to (24).
In this case, the bandwidth for disturbance suppression is fixed.
The responses of (d)(f) follow the position command quickly
and precisely. From the comparison between Fig. 11(a)(c)
and (d)(f), it is verified that the bandwidth for disturbance
suppression depends on the inertia variation.
The experimental results of the force control system are
shown in Fig. 12. Fig. 12(a)(c) are the position responses and
Fig. 12(d)(f) are the force responses. The force command is
1 Nm. The environment is expanded polystyrene. The bandwidth for disturbance suppression is fixed by selecting the
cutoff frequency of the disturbance observer as (24). The
bandwidth for torque estimation is set to the same value as
the bandwidth for disturbance suppression. The responses of
(a) and (d) include the phase lag compensation based on the
disturbance observer. It shows that the system could not stably
contact with the environment. When an end-effector contacts
with the environment, a reaction torque loop appears in a
control system. Then, the system becomes oscillatory, and the
end-effector is repulsed from the environment. When the endeffector gets away from the environment, the reaction torque
loop disappears, and the system becomes stable. Furthermore,
the end-effector falls down and contacts with the environment again. This process was repeated again and again in
the responses of (a) and (d). Hence, stable contact with the
environment could not be attained in this case. On the contrary,
the responses of (b), (c), (e), and (f) show that the system could
contact stably. The responses of (b) and (e) include no phase
compensation, and the responses of (c) and (f) include the phase
lead compensation based on disturbance observer. From the
responses during contact time, it is proved that the response
of (c) was able to contact more stably than the response of (b).
This means that the phase compensation based on disturbance
observer makes the force control system more stable.
VI. C ONCLUSION
3420
Fig. 11. Experimental results of position contral system. (a) Position response (gdis = G, = 0.1). (b) Position response (gdis = G, = 1.0).
1
1
G, = 0.1). (e) Position response (gdis =
G, = 1.0). (f) Position response
(c) Position response (gdis = G, = 1.6). (d) Position response (gdis =
1
G, = 4.0).
(gdis =
1
1
Fig. 12. Experimental results of force control system. (a) Position response (gdis =
G, = 0.5). (b) Position response (gdis =
G, = 1.0).
1
1
1
G, = 2.0). (d) Force response (gdis =
G, = 0.5). (e) Force response (gdis =
G, = 1.0). (f) Force response
(c) Position response (gdis =
1
G, = 2.0).
(gdis =
model parameters are much separated from the actual ones, the
stability of the control system deteriorates. The main contribution of this paper is to show that the bandwidth for distur-
KOBAYASHI et al.: ANALYSIS OF PARAMETER VARIATIONS OF DISTURBANCE OBSERVER FOR MOTION CONTROL
3421
R EFERENCES
[1] J. K. Salisbury, Active stiffness control of a manipulator in Cartesian
coordinates, in Proc. 19th IEEE CDC, 1980, pp. 95100.
[2] M. H. Raibert and J. J. Craig, Hybrid position/force control of manipulators, Trans. ASME, J. Dyn. Syst. Meas. Control, vol. 102, pp. 126133,
1981.
[3] N. Hogan, Impedance control: An approach to manipulator,
Part: ITheory, Trans. ASME J. Dyn. Syst. Meas. Control, vol. 107,
no. 1, pp. 17, Mar. 1985.
[4] N. Hogan, Impedance control: An approach to manipulator,
Part: IIImplementation, Trans. ASME J. Dyn. Syst. Meas. Control,
vol. 107, no. 1, pp. 816, Mar. 1985.
[5] N. Hogan, Impedance control: An approach to manipulator,
Part: IIIApplications, Trans. ASME J. Dyn. Syst. Meas. Control,
vol. 107, no. 1, pp. 1724, Mar. 1985.
[6] X. L. Wu, J. D. Han, and S. K. Tso, Experimental study of contact
transition control incorporating joint acceleration feedback, IEEE/ASME
Trans. Mechatronics, vol. 5, no. 3, pp. 292301, Sep. 2000.
[7] S. Jung and T. C. Hsia, Robust neural force control scheme under uncertainties in robot dynamics and unknown environment, IEEE Trans. Ind.
Electron., vol. 47, no. 2, pp. 403412, Apr. 2000.
[8] D. A. Lawrence, Stability and transparency in bilateral teleoperation,
IEEE Trans. Robot. Autom., vol. 9, no. 5, pp. 624637, Oct. 1993.
[9] Y. Yokokohji and T. Yoshikawa, Bilateral control of masterslave manipulator for ideal kinesthetic couplingFormulation and experiment,
IEEE Trans. Robot. Autom., vol. 10, no. 5, pp. 605620, Oct. 1994.
[10] S. Katsura, Y. Matsumoto, and K. Ohnishi, Realization of law of action
and reaction by multilateral control, IEEE Trans. Ind. Electron., vol. 52,
no. 5, pp. 11961205, Oct. 2005.
[11] S. Katsura, Y. Matsumoto, and K. Ohnishi, Transmission of force sensation by environment quarrier based on multilateral control, IEEE Trans.
Ind. Electron., vol. 54, no. 2, pp. 898906, Apr. 2007.
[12] Y. Matsumoto, S. Katsura, and K. Ohnishi, Dexterous manipulation
in constrained bilateral teleoperation using controlled supporting point,
IEEE Trans. Ind. Electron., vol. 54, no. 2, pp. 11131121, Apr. 2007.
[13] R. J. Adams and B. Hannaford, Stable haptic interaction with virtual
environments, IEEE Trans. Robot. Autom., vol. 15, no. 3, pp. 465474,
Jun. 1999.
[14] T. Shimono, S. Katsura, and K. Ohnishi, Abstraction and reproduction of
force sensation from real environment by bilateral control, IEEE Trans.
Ind. Electron., vol. 54, no. 2, pp. 907918, Apr. 2007.
[15] S. Katsura and K. Ohnishi, A realization of haptic training system by
multilateral control, IEEE Trans. Ind. Electron., vol. 53, no. 6, pp. 1935
1942, Dec. 2007.
[16] K. Ohishi, K. Ohnishi, and K. Miyachi, Torque-speed regulation of DC
motor based on load torque estimation, in Proc. IEEJ IPEC-TOKYO,
1983, vol. 2, pp. 12091216.
[17] K. Ohnishi, M. Shibata, and T. Murakami, Motion control for advanced
mechatronics, IEEE/ASME Trans. Mechatronics, vol. 1, no. 1, pp. 5667,
Mar. 1996.
[18] S. Katsura and K. Ohnishi, Absolute stabilization of multi-mass resonant
system by phase-lead compensator based on disturbance observer, in
Proc. 8th IEEE Int. Workshop AMC, 2006, pp. 194199.
[19] T. Murakami and K. Ohnishi, A study of stability and workspace decoupling control based on robust control in multi-degrees-of-freedom robot,
IEEJ Trans. Ind. Appl., vol. 113-D, no. 5, pp. 639646, 1993.
[20] M. Bertoluzzo, G. Buja, and E. Stampacchia, Performance analysis of
a high-bandwidth torque disturbance compensator, IEEE/ASME Trans.
Mechatronics, vol. 9, no. 4, pp. 653660, Dec. 2004.
Kouhei Ohnishi (S78M80SM00F01) received the B.E., M.E., and Ph.D. degrees in electrical
engineering from the University of Tokyo, Tokyo,
Japan, in 1975, 1977, and 1980, respectively.
Since 1980, he has been with the Department
of System Design Engineering, Keio University,
Yokohama, Japan. His research interests include
power electronics, mechatronics, motion control, and
robotics.
Dr. Ohnishi received Best Paper Awards from the
Institute of Electrical Engineers of Japan and the
Japan Society for Precision Engineering, and the Outstanding Paper Awards
at IECON85, IECON92, and IECON93. He also received the EPE-PEMC
Council Award and the Dr.-Ing. Eugene Mittelmann Achievement Award from
the IEEE Industrial Electronics Society in 2004.