Академический Документы
Профессиональный Документы
Культура Документы
Abstract-The application of a sliding-mode control based on a-- 2) robustness of the manipulator control to the unknown
Variable Structure System (VSS) for a multijoint manipulator is pre- parameter variations or modeling ambiguities.
sented. The high-gain effect of a sliding-mode control suppresses the
complicated interactions between each joint of a robot arm. The resulting To overcome the above difficulties, the authors of this paper
system is completely robust whereas the obtained control law is simple developed a sliding-mode controller based on the Variable
and easy to apply to on-line computer control. In this -paper, the practical
sliding-mode controller, which has a simple nonlinear compensator and
Structure System (VSS) theory [41, [5]. The main feature of
proper continuous function, is implemented for a two-linkage manipula- sliding-mode control is that a sliding mode occurs on a
tor. The validity of this technique is confirmed in experiments where the predetermined switching surface. While in sliding mode, the
system shows robust performance in spite of the existing nonlinear system will be forced to "slide"' along or nearby the vicinity
interactions and unkuown parametric changes. In addition, this sliding- of the switching surface. The system is then robust and
mode control is improved to track the desired path.
insensitive to the interactions as well as to unmodeled
dynamics. In addition, the designer does not require an,
I. INTRODUCTION accurate model of the plant: it is only necessary to how the
OST of the computer-controlled robots are serial linkage boundaries of the parameter variations and load disturbances.
manipulators because their available workspace is large. The sliding-mode control strategy proposed in this paper
Such a multijoint robot arm, however, is a highly nonlinear includes not only a sliding mode but also simple nonlinear
system with complicated interactions between each of the compensators, while previous methods [6], [71 utilized the
joints. These interactions represent gravitational forces depen- sliding mode alone. In the new method, the, majority of
dent on positions of the arm, reaction forces due to accelera- interactions in the manipulator dynamics, which are easy to
tions of other joints, and Coriolis and centrifugal forces. estimate precisely in the course of modeling, are removed by
Furthermore, there are parameters dependent on the variable simple nonlinear compensators. The rest of the interactions are
payloads carried by robots in the manufacturing process. eliminated by the sliding mode. This technique suppresses the
In regard to such complicated interactions, quite a number chattering caused by the discontinuous control input. In
of papers have been presented on the aspect of manipulator addition, a proper continuous fnction is introduced to remove
control. Linear feedback control using linearized models as the high-frequency component of control input.
the basis for decoupling and control have been proposed. This As for experiments of this paper, continuous-path motion is
method is, however, only valid in cases where some condi- executed because the strict tracking of a desired path must be
tions are satisfied. For example, the rate-resolved control required in the prospective control of improved robots. For
method [1] will not keep good performances while manipula- this purpose, sliding-mode control is improved to track
tors are in high-speed motion. The nonlinear control system arbitrary trajectories.
based on complete decoupling [21 is effective in high-speed A two-linkage manipulator is taken as an example of a
motion, but the nonlinear compensations are complex and multijoint manipulator. The characteristics of the developed
costly to compute. The Newton-Euler method [3] solves the method are clarified through experimental results.
on-line computational problem of manipulators, but, such a II. CONTROL METHODOLOGY
scheme has the shortcoming that computing inaccuracies will
be caused if the system contains unknown parameter varia- First, we implement sl-iding-mode control for a robotic
tions. manipulator (two-linkage manipulator in experiment). Second,
In order to realize the on-line manipulator control in high- simple nonlinear compensators are also used to mitigate the
speed motion, the following two points are the key problems extent of "chattering." Last, instead of a relay function, a
for which designers must choose a control law: continuous fnction is introduced in order to remove the high-
frequency component of control input.
1) avoidance of complex computations for the nonlinear
compensation; and A. Sliding-Mode Control
Sliding-mode control based on VSS is characterized by
Manuscript received March 30, 1985; -revised September 15, 1986. discontinuous control which changes "structure" upon reach-
H. Hashimoto and F. Harashima are with the Institute of Industrial Science, ing a set of predetermined switching surfaces in the state space
University of Tokyo 7-22-1, Roppongi, Minato-ku, Tokyo 106, Japan.
K. Maruyama is with Japan Radio Company, Ltd., 5-1-1, Shimorenjaku, [4], [5]. A general type is considered, represented by
Mitaka-shi, Tokyo, 181 Japan.
IEEE Log Number 8611672. ,. =f(x, t) + B (x,, t) u (1)
0278/0046/87/0200-001 1$0l .00 1987 IEEE
12 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. IE-34, NO. 1, FEBRUARY 1987
where
x, f ERn S wit
u E RmX surff ace
B E Rnxmn.
The control input has the form Fig. 1. Sliding mode.
if sj(x)>0 by substituting ueq into the original equation (1). The invariant
ui(x, t)= =
is symmetric and positive definite. Equation (10) is trans- where dC(O, 0, 0) are unknown dynamics dependent on
formed into parameter variations, model ambiguities, and so on. But in
order to calculate the control input, the following assumption
6=M() 1[u-f(O, 0)- V6-g(o)]. (13) is imposed on d,(6, 0, 0):
Substituting (13) into s = 0 yields the equivalent control
di(O, 6, 6)1 :!!. yi (22)
Ueq -f=(, 0) + V + g( M()Od CO) (14) where -y is a positive constant. y is dependent on errors
)+ -
wheref(O, 0), V6, g(0), and M(6) have parameters dependent between the true parameters and the estimated parameters of
on the manipulator structure and the payload it carries. It is arm dynamics. Ari has the following form:
difficult to obtain a completely accurate value for these
parameters. Therefore the following equation is used which is Ari= ((pi ei + tj 1,6i + k,) sign (si). (23)
estimated as precisely as possible: This method is suitable for the decentralized controller of
the multilinkage manipulator, because the required
taeq=ueq + A Ueq (15) tion is restricted to the state of each joint and the informa-
obtained
where Cieq indicates the estimated value. Auq corresponds to algorithm is very simple and practical.
the unknown dynamics of (14) caused by the parameter
variations, variable payload, and disturbances. IV. EXPERIMENT
3. Calculate Control Input: The control input is of the A. Description of Experimental System
form A robotic manipulator must have three degrees of freedom,
u =aeq+Au. (16) Twoleast,
at in order to move to an arbitrary point in the space.
degrees of freedom, however, are sufficient for examin--
aeq is a nonlinear term and Au is a sliding-mode term in (16). ing the validity of the control method, since two-linkage
y IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. IE.34, NO. 1, FEBRUARY 1987
12b,,t ::
12btt I lW
TABLEI
ACTUATOR CHRCTRSTC
Lower Upper
arm arm
JUfoer are 3cs 80:1 Hormonic drive
(.m?51 ~ ()+1:229x}0cose,
e N3
89 4 .20 4 .52
at 10 lcHz.: A 1000-pulse-per-revolution shaft encoder is used al,t5) +4.42x104cos12 +7.44XlO'cos,2
I
MB. athematical Model of Two-Linkage Manipulator detached from the other joint. Note that these values are
The, dynamics of the manipulator including actuators are estimated ones based on the arm model and rather different
described in from true values of the real arm. Probably the magnitude of
errors is within 20 percent except for viscous damping forces.
[u1u2 La,2(0)
[ra11I (O)
-
a12(0) 1
a22
PR
02
Viscous damping forces vary widely during rotation and also
depend on rotational direction. Therefore their values in (24)
are averages during rotation in fixed direction.
: dai22 c+ ail:a1
2
2
2 .1f2+P
.
}8 C. Continuous-Path:Control
(24)
In order to examine the validity of the proposed method, the
whole system is forced to move along the desired trajectories,
namely, it is under continuous-path control. The desired
trajectories are illustrated in Fig. 4. In addition, the calculated
where v1 - 7.8 and v2 = 3.2. angular position, velocity, and acceleration of each joint are
These values are shown in Table II in the case when the arm shown in Fig. 5.
has: variable payload. The inertia variations,l the centrifugal
forces, and: the Coriolis forces are small enough compared D. Constitution of Control Input
with the gravitational forces PI and P2 because of the effect of The simple nonlinear compensate term teiq is as follows:
fthe& harmonic drive (1:80). The terms: of viscous damping
forces v161 and u202 are obtained by actually rotating each joint Ueq= +g(i) +M-(O)(6d- C) (25)
HASHIMOTO et at.: ROBOT MANIPULATOR CONTROL WITH SLIDING MODE 15
where
daa2 daa
fi(0 O)= , 02+
> d 102
dO2 d9o
f2(0, 6> - - 92
2 d 02 "*
Fig. 4. Desired trajectory. Since (alla22 - a'2) is always positive in spite of modeling
ambiguities, the control gains are chosen to satisfy the
2.5 5 following inequalities:
( 1<
62
S2A2 =
(alla22 i 1s2[al2fl (0, 6)
N,
*:
- allf2(0, 0)] +S2AT2<O
NO
N( r
where V, g(9) and M(0) are estimates of V, g(O) and M(0), allaall2
respectively. Inertia variations, centrifugal forces, and Cor- +
2 aO2
02.
iolis forces are regarded as unknown dynamics Aueq of (15).
Actual control input u is
This design procedure can be realized, because the diagonal
U =ieq +M(9)AT (26) component of M(0) - 1M(O) in (19) is more than the sum of
where other absolute components in the same row in experiments.
Ari= (9oI ei +-tj I es + k) sign (si) That is, the MIMO system is decomposited into SISO systems
by regarding the nondiagonal components as disturbances.
si = ij+ ciei, (i1, 2). Where the nondiagonal components are too large to be
E. Decision of Control Gains regarded as disturbances, the accuracy of M(9) will play a
more important role in such a case.
Control gains Soi and (i are selected so as to satisfy the
sliding-mode existence condition (4) as follows: Taking maximum velocities, modeling ambiguities, and
disturbances into consideration, the gain constants in experi-
ments are chosen as following those shown in Table III. Note
s11 =(alla22-a12)1-sI[-a22f1(0, 6)
that ki may not satisfy the condition in (28) and (29) partly in
+ al2f2(0, 6)] + s1 AT, < 0 (27) the area where the arm is in high-speed motion. However,
16 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. IE-34, NO. 1, FEBRUARY 1987
z
Gain constants i=1 i==2
i (N.m/rad) s5 -50 0.0
f (N.m.sec/rad) -150 -150
c (1/ec) 30 30 I-
0 200 ,
0-
0E
since sjsi is kept negative by the other terms, ki satisfies the .
tracking performance of the upper arm with payload (2 kg) are c- -10I
shown in Fiig. 6. The continuous function is set up at 6 = 0.1. 5
errors are nearly the same throughout transient response and, Io- III, I
for steady state, errors are not seen. These results show good z -50
performances considering the maximum position-sensor reso- 0
0
lution of 0.0140. The maximum tracking error is about Io0n
.I.
1.0
m
0 start point end point
la:cc 0 100 Iv ..
0 * t .Ii
.U -1.0
0 0.5 1.0 * 0
TIME (sec)
(b) I- -00
z
0 -50
1.0 .
0-
0 -100
.~~~~~~~
0 0.5 1.0
0) TIME (sec)
lY: .I
0 .~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ (a)
cc
- 1.0
0 0.5 1.0
TIME (sec)
(c) z
Fig. 7. Tracking error of upper arm (tuned at 2-kg payload) 6 - 0.1: (a) .-
without payload; (b) with 2-kg p'ayload; and (c) with 4-kg payload.
-J
0
z
0
starlt point end point
1.0
0)
C)
10
cc cc (b)
|~'
0
0
cc
w
R l
.s te l t 1- ! ~~~~~~~~~~~~~~~~~~~~~~~~~~I X
100
-1.0
0 1.0
TIME (sec)
a: I-
(a)
Z
z 0
-
1.0
0)
10 z -50
0
a0
0 - 100 L.. .I j -t I
0 0.5 1.0
-1.0 TIME (sec)
0 0.5 1.0
(c)
TIME (sec)
PD control Fig. 9. Effect of continuous function (calculated control input in micropro-
(b) cessor, upper arm, 2-kg payload): (a) without continuous function, a = 0;
Fig. 8. Comparison of tracking error (tuned at 2-kg payload, upper arm, 4-
(b) with continuous function, 6 = 0.1; and (c) with continuous function, 6
= 0.5.
kg payload): (a) sliding-mode control, 6 0. 1; and (b) PD control.
start point end point would then change into a continuous-type control which is
1.0
v
tuned to the best condition based on estimated payload.
10 -
~~~~~
.1 REFERENCES
0 -
a: [1] D. E. Whitney, "Resolved rate control of manipulators and human
-1.0 prostheses," IEEE Trans. Man.-Mach. Syst., vol. MMS-10, pp. 47-
53, 1969.
o ~~~~~~~0.5TIME (sec) 1.0 [2] E. Freund, "Fast nonlinear control with arbitrary pole-placement for
(a) industrial robots and manipulators," Robotics Res., vol. 1, no. 1, pp.
65-78, 1982.
_^1.0 [31 J. Y. S. Luh and M. W. Walker, "On-line computational scheme for
.-
0)
mechanical manipulators," Trans. ASME, J. DSMC, vol. 102, pp.
69-76, June 1980.
[4] V. I. Utkin, "Variable structure systems with sliding modes," IEEE
Trans. Automat. Contr., vol. AC-22, pp. 212-222, 1977.
a: [5] V. I. Utkin, Sliding Modes and Their Application in Variable
LII
-1.0 Structure Systems. Moscow: Mir, 1978.
0 0.5 1.0 [6] K. D. Young, "Controller design for a manipulator using theory of
TIME (sec) variable structure systems," IEEE Trans. Syst. Man, Cybernetics,
0 (b) vol. SMC-8, pp. 101-109, 1978.
[7] J. J. Slotine and S. S. Sastry, "Tracking control of nonlinear systems
_^1.0 using sliding surfaces, with application to robot manipulators," Int. J.
Contr., vol. 38, no. 2, pp. 465-492, 1983.
[8] G. Ambrosino, G. Celentano, and F. Garofalo, "Variable structure
a: model reference adaptive control systems," Int. J. Contr,, vol. 39,
no. 6, pp. 1339-1349, 1984.
a:
LL
-1.0 ,I 1 1 , 1
_1 [9] R. P. Paul, Robot Manipulators: Mathematics, Programming and
Control. Cambridge, MA: M.I.T. Press, 1981.
0
0.5
TIME (sec)
1.0
[10] F. Harashima, H. Hashimoto, and S. Kondo, "MOSFET converter-fed
position servo system with sliding mode control," IEEE Trans. Ind.
(c)
Electron., vol. IE-32, no. 3, pp. 238-244, 1985.
Fig. 10. Effect of continuous function (tracking error of upper arm): (a) [1 ] F. Harashima, H. Hashimoto, and K. Maruyama, "Practical robust
without continuous function, 6 = 0; (b) with continuous function, = 0.1; control of robot arm using variable structure system," in Proc. 1986
and (c) with continuous function, 6 = 0.5. IEEE Conf. Robotics, Automation (San Francisco, CA), Apr. 1986.