1, FEBRUARY 2006 55
Abstract—In this paper, a practical method is proposed to sup- in their structure and robust against disturbances or parameter
press residual vibrations of industrial robots without a real-time variations, thus very useful for practical applications.
estimation of vibration frequencies. Through theoretical analysis Based on the observations above, we have considered the in-
and experiments, we designed an input shaping technique (IST)
for the first three axes of a six-degrees-of-freedom industrial robot. put shaping technique (IST) proposed by Singer and Seering [3]
Iterative learning IST (LIST) is applied to the first axis to suppress as the feedforward scheme to be combined with a feedback
its time-varying nonlinear residual vibration, while conventional controller. Since the beginning, the IST has attracted attention
IST is applied to the second and third axes. Experimental results owing to its effectiveness and simplicity. Its effectiveness has
show that LIST can suppress residual vibrations to a level similar been proven in practical systems such as ship cranes [5], chip
to that of a time-varying IST which requires complicated real-time
estimation of a dynamic model. The LIST is an attractive method mounters [6] and open container, of liquid [7]. Nevertheless,
for suppression of nonlinear and time-varying residual vibrations since the IST was proposed originally for linear time-invariant
in industrial robots which perform repetitive tasks because most systems [3], it is not so effective for systems with nonlinear
industrial robots have limited computing power and memory space and time-varying characteristics such as the multilink robots
in their controllers. we are interested in. Even robust IST [3], which compensates
Index Terms—Flexible structure, industrial robot, input shap- for inaccuracies of frequency estimation, is not of much help
ing, iterative learning algorithm, residual vibration. for these systems.
To overcome this difficulty, many attempts have been made
to improve IST for nonlinear and time-varying systems. As for
I. INTRODUCTION
nonrobotic systems, online adaptive schemes were developed by
N controlling industrial robots, fast and precise motions are
I required for better productivity. Such motions, however, are
often restricted by residual vibrations in the end-effector, which
Tzes and Yurkovich [8] and Bodson [9]. As for robotic systems,
Rappole [10] applied a time-varying IST (TVIST) to a two-link
flexible manipulator using a lookup table. Magee and Book [11]
tend to be time varying and nonlinear due to the configuration- modified the IST to eliminate the first two modes of vibration in
dependent friction, inertia variation, and nonlinear stiffness of a large and flexible manipulator with a configuration-dependent
joints. inertia. Cho and Park [12] proposed a method to determine the
For suppression of residual vibrations in flexible systems, exact time-varying impulse sequence and applied it to a two-link
there are two distinct approaches: open-loop feedforward [1] flexible robot. Additionally; there have been similar attempts to
and closed-loop feedback [2]. In terms of performance, the latter apply the IST to various robots [13].
scheme is more attractive than the former because it is inherently But these schemes require intensive computing power for
more robust against disturbances and parameter variations. In real-time computation or memory space for a frequency map.
terms of practical implementation, however, the closed-loop Moreover, some schemes require an exact dynamic model of the
approach makes overall systems more complex and expensive. plant in real time. Because of the limited computing power and
More specifically, the increased states due to vibrational modes memory space of industrial robots, however, it is difficult to meet
increase the order of the control systems, thereby requiring more these requirements. Furthermore, it is a major work to obtain
computation and more sensors as well as the measurability of the an exact model for an industrial robot. These practical issues
additional states. Because of these difficulties, many researchers have made us develop a scheme to adopt IST for an industrial
have developed feedforward schemes integrated with feedback robot.
controllers [3], [4]. They reported that the schemes are simple The IST we employed in this paper is an iterative learning
IST (LIST) [14], which iteratively updates the parameters of
IST based on data from previous trials. The idea central to
Manuscript received December 24, 2003; revised April 18, 2005. Recom-
mended by Technical Editor R. V. Patel. The work of P.-H. Chang was supported this approach came from our observation that most tasks of
by the Korea Science and Engineering Foundation (KOSEF) through the Center industrial robots are planned in advance and they are repet-
for Human-Friendly Welfare Robotic Systems (HWRS). itive by nature. The robot to which we apply iterative LIST
J. Park is with Daewoo Shipbuilding and Marine Engineering Company Ltd.,
Koje City, 656-714 Korea. is an industrial robot which carries heavy payloads on plant
P.-H. Chang and E. Lee are with the Korea Advanced Institute of Science and floors. Since IST and LIST were developed originally for single-
Technology (KAIST), Daejon 305-701, Korea. input single-output (SISO) systems, this paper deals with tech-
H.-S. Park is with the Rehabilitation Institute of Chicago, Chicago, IL 60611
USA. niques to extend the application of IST and LIST to industrial
Digital Object Identifier 10.1109/TMECH.2005.863365 robots that are multiple-input multiple-output (MIMO) systems.
TABLE I
PARAMETERS OF THE ROBOT
The industrial robot of our interest has a parallelogram- M64 θ̈2 + M66 θ̈3 + b3 θ̇3 − bk 3 θ̇r 3 − KT 3 θr 3
linkage structure with six degrees of freedom (6 DOF). The +N3 (θ, θ̇) + G3 (θ) = 0 (6)
schematic diagram of the robot is shown in Fig. 1 and its esti-
mated parameters are presented in Table I. As can be expected where θr i = ( θrmi i − θi ), θ = [θ1 θ2 θ3 ]T ; and Ni (θ, θ̇) denotes
from the numerical values of these parameters, the robot is in- the Coriolis and centrifugal torque and Gi (θ) the gravity torque
tended for handling heavy payloads or spot welding with the at the ith joint; Ni (θ, θ̇)s and Gi (θ)s are shown in Appendix I.
maximum payload of 120 kg. In the equations above, it is assumed that viscous damping with
To examine its frequency variation properties, the dynamic a coefficient of bm i is also present at each motor, bi at each joint,
equation of the robot was derived based on the schematic di- and bk i at each torsional spring.
agram depicted in Fig. 1. Note that these last three axes have Under the assumption that each link has a uniform and
little effect on inertia variation and, thus, on frequency variation. symmetric cross section, the elements of inertia matrix Mij (θ)s
PARK et al.: INPUT SHAPING TECHNIQUE FOR AN INDUSTRIAL ROBOT 57
can be expressed as the following: are drawn from the analysis of dynamic equations of the robot
and experimental verification.
M11 = Jm 1 (7)
1) For axes 1, 2, and 3, the variation of IST parameters in
2 2 2 2
M22 = (ma lg a + Ja + Jc )c2 + (mb lg b + Jb + Jd )c3 one axis has little effect on the residual vibration of the
other two. For example, even though the IST parameters
+ mc (lb c3 − lg c c2 )2 + md (lc c2 + lg d c3 )2
of axis 1 are changed, the residual vibration in axes 2 and 3
+ mP {lc c2 + (ld − lb )c3 }2 (8) are affected only slightly (Appendix II).
2) Residual vibration in axis 1 is dominant while those in
M33 = Jm 2 (9)
axes 2 and 3 are relatively small (see Fig. 10).
M44 = ma lg a 2 + Ja + mc lg c 2 + Jc + md la 2 + mP la 2 (10) Based on these observations, we have developed a strategy to
determine IST parameters as follows.
M46 = {md la lg d − mc lb lg c + mP la (ld − lb )} cos(θ2 − θ3 )
1) Apply conventional IST to axes 2 and 3. Although the
(11) residual vibrations in axes 2 and 3 are not eliminated
entirely with conventional IST, the remaining vibrations
M64 = M46 (12)
are negligible so that conventional IST can be used in these
M55 = Jm 3 (13) axes without fine tuning.
2) Tune IST parameters for axis 1 by applying iterative learn-
M66 = mb lg b + Jb + mc lb + md lg d + Jd + mP (ld − lb )2
2 2 2
ing algorithm.
(14)
where lk and lg k (k = a, b, c, d), as shown in Fig. 1, denote the III. ITERATIVE LEARNING INPUT SHAPING TECHNIQUE
length of the corresponding link and the length to the center of
A. IST and Measures of Residual Vibrations
gravity of the link, respectively. In the same manner, mk and
Jk represent the mass and moment of inertia of the link, respec- The two-impulse sequence for suppression of the residual
tively. In addition, mP denotes the payload, attached to the end- vibration is given in the following general form:
effector, and ci and si symbolize cos θi and sin θi , respectively.
u(s) = A1 e−T 1 s + A2 e−T 2 s r(s) (16)
Note in (8) and (11) that M22 and M46 vary with both θ2 and
θ3 , whereas (10) and (14) show that M44 and M66 are constant. where r(s) is a reference trajectory. The two-impulse sequence
Owing to M22 and M46 , hence, the robot has time-varying u(s) has four parameters: the magnitudes of impulses A1 and
vibrations [15]. A2 , and the application time T1 and T2 . Without loss of general-
The vibration is not only time varying, but also nonlinear ity, T1 may be fixed to 0 for a faster response, and A2 may also
due to robot dynamics such as nonlinear spring characteristics be fixed to (1 − A1 ) in order to maintain a unit gain. Then, there
of harmonic drive and friction. Moreover, nonlinear terms in remain only two independent parameters to be determined, A1
dynamic equations, such as Coriolis, centrifugal, and gravity and T2 .
torque, cause nonlinear residual vibration of the robot. As an According to Singer and Seering’s study [3], the residual
example, let us examine N1 , which can be expressed in the vibrations due to the two-impulse sequence vanish if A1 and
following form: T2 are properly selected by the following equations:
N1 (θ, θ̇) = f1 (θ2 , θ3 , θ̇2 , θ̇3 )θ˙1 . (15) 1
A1n = √ 2 (17)
Since f1 (θ2 , θ3 , θ̇2 , θ̇3 ) is a nonlinear function, N1 (θ, θ̇) can 1+e −ζ π /
1−ζ
be regarded as a nonlinear damper with a nonlinear damping π
coefficient. Therefore, we can see that the nonlinear terms in T2n = (18)
N1 cause nonlinear residual vibration of the robot. ωn 1 − ζ 2
Due to such time-varying and nonlinear characteristics, resid- where ( · )n denotes the exact values of ( · ), and ζ and ωn mean
ual vibrations of industrial robots are not well suppressed by the damping ratio and the natural frequency of the residual
conventional IST, which was derived for linear time-invariant vibration to be suppressed, respectively.
(LTI) systems [8]–[10], [12]. To this end, we may apply mod- When A1 = A1n or T2 = T2n , however, the residual vibra-
ified versions of the IST technique for the robot. The authors, tion does not vanish after the application time T2 . For exam-
however, found that, with properly tuned IST parameters, con- ples, we examined the responses for four cases: T2 > T2n and
ventional IST can suppress residual vibration in nonlinear and T2 < T2n for A1 = A1n , and A1 > A1n and A1 < A1n for
time-varying systems [14], [16]–[18]. Since conventional IST T2 = T2n . Fig. 3 shows the responses to the two-impulse se-
does not require intensive computational time or large memory quence for these four cases. In the figure, the solid lines rep-
space, we employed IST to suppress the residual vibration of resent the original vibration, the unit impulse response without
the industrial robot. IST, and the dotted lines represent the resultant responses to
the two-impulse sequence. Fig. 3(a) shows the response for the
B. IST Application Strategy for the Robot
case T2 > T2n , and Fig. 3(c) for the case T2 < T2n ; Fig. 3(b)
The dynamic equations above clearly show that the robot is a for the case A1 > A1n , and Fig. 3(d) for the case A1 < A1n .
multivariable system. Nevertheless, the following observations Both responses show that the residual vibrations still persist and
58 IEEE/ASME TRANSACTIONS ON MECHATRONICS, VOL. 11, NO. 1, FEBRUARY 2006
Fig. 3. Responses to the two-impulse sequence with inaccurate parameters. Solid lines represent unit impulse responses; dashed lines represent the resultant
responses to the two-impulse sequence with T 2 = T 2n or A 1 = A 1n .
Fig. 4. Variation of M and φ: (a) for T 2 varying with A 1 fixed, (b) for A 1 varying with T 2 fixed.
Fig. 8. p k +1 is not in the interval where M has a minimum when the parameter
is updated improperly.
Fig. 9. Experimental setups used for the LIST. The learning process is done
on the IBM-PC 486.
As a remedy to overcome this difficulty, the following con-
straint is added: (23), we can obtain the following equation to calculate pk +1 :
Fig. 10. Experimental results: residual vibration without IST. Note that the Fig. 11. Experimental results. Magnitude measure M decreases as the number
robot moved for 1.35 s and the tip response after 1.35 s is the residual vibration. of iterations increases.
APPENDIX III
CONVERGENCE OF LIST
Fig. 14. Residual vibrations with various IST parameters of axis 1: θi − θm i For the purpose of verifying the convergence of the proposed
after settling time (a) without IST, (b) with IST, and (c) with IST parameter updating rule, the error (p − pn ) is examined. First, the updating
variation in axis 1. Note that dashed and thick solid lines overlap each other in condition is divided into the following two cases for examina-
axes 2 and 3.
tion.
Case 1) Both pk −1 and pk are smaller or larger than pn as
TABLE III shown in Fig. 15(a).
TRAJECTORIES AND SIMULATIONS RESULTS
Case 2) Either pk −1 or pk is smaller than pn and the other is
larger than pn as shown in Fig. 15(b).
Without loss of generality, we considered a situation repre-
sented in Fig. 15(a) for Case 1. By subtracting pn from both
sides of (23), we obtain
M̃k
ek +1 = ek + (pk − pk −1 )sat (29)
M̃k −1 − M̃k
Equations (31) and (32) can be combined as follows: [5] M. Agostini, G. G. Parker, K. Groom, H. Schaub, and R. D. Robinett,
“Command shaping and closed-loop control interactions for a ship
|ek +1 | < max[|ek |, |ek −1 |]. (33) crane(I),” in Proc. 2002 American Control Conf., 2002, pp. 2298–2304.
[6] P. H. Chang and J. Park, “A concurrent design of input shaping tech-
Moreover, (33) can be represented as (34) by introducing a nique and a robust control for high-speed/high-precision control of a chip
mounter,” Control Eng. Practice, vol. 9, no. 12, pp. 1279–1285, Dec.
constant ck +1 which satisfies 0 < ck +1 < 1: 2001.
[7] J. T. Feddema et al., “Control for slosh-free motion of an open container,”
|ek +1 | < ck +1 max[|ek |, |ek −1 |]. (34) IEEE Control Syst. Mag., vol. 17, no. 1, pp. 29–36, Feb. 1997.
[8] A. Tzes and S. Yurkovich, “An adaptive input shaping control scheme for
vibration suppression in slewing flexible structures,” IEEE Trans. Contr.
In Case 2, we obtain the following equation from (21): Syst. Technol., vol. 1, no. 2, pp. 114–121, Jun. 1993.
[9] M. Bodson, “An adaptive algorithm for the tuning of two input shaping
methods,” in Proc. American Control Conf., vol. 3, 1997, pp. 1340–1344.
M̃k −1 ek − M̃k ek −1 [10] B. W. Rappole, “Minimizing residual vibrations in flexible systems,” Mas-
ek +1 = . (35) ter’s thesis, Dept. Mech. Eng., MIT, Cambridge, MA, 1992.
M̃k −1 − M̃k [11] D. P. Magee and W. J. Book, “Implementing modified command filtering
to eliminate multiple modes of vibration,” in Proc. 1993 American Control
Since ek ek −1 < 0 and M̃k M̃k −1 < 0 as shown in Fig. 15(b), Conf., Jun. 1993, pp. 2700–2704.
(35) becomes [12] J. K. Cho and Y. Park, “Vibration reduction in flexible systems using a
time-varying impulse sequence,” Robotica, vol. 13, pp. 305–313, 1995.
[13] R. Kinceler and P. H. Meckl, “Corrective input shaping for a flexible-joint
M̃k −1 ek | − |M̃k ek −1 manipulator performing point-to-point motion,” in Proc. IEEE Int. Conf.
|ek +1 | =
|M̃k −1 | + |M̃k | Control Applications, 1996, pp. 391–396.
[14] J. Park and P. H. Chang, “Learning input shaping technique for non-LTI
systems,” Trans. ASME, J. Dyn. Syst. Meas. Control, vol. 123, pp. 288–
M̃k −1 | − |M̃k
≤ max(|ek |, |ek −1 |) 293, Jun. 2001.
|M̃k −1 | + |M̃k | [15] H. S. Park, P. H. Chang, and J. S. Hur, “Time-varying input shaping
technique for an industrial robot,” in Proc. IEEE/RSJ Int. Conf. Intelligent
< ck +1 max(|ek |, |ek −1 |) (36) Robots and Systems, vol. 1, 1999, pp. 285–290.
[16] J. Y. Smith, K. Kozak, and W. E. Singhose, “Input shaping for a simple
nonlinear system,” in Proc. American Control Conf., 2002, pp. 821–826.
where ck +1 is a constant which satisfies (max (|M̃k −1 |, |M̃k |))/ [17] J. Park, P. H. Chang, and E. Lee, “Can a time invariant input shaping
(|M̃k −1 | + |M̃k |) < ck +1 < 1. technique eliminate residual vibrations of LTV systems?,” in Proc. 2002
From (34) and (36), we can say that |ek +1 | has the following American Control Conf., 2002, pp. 2292–2297.
[18] J. Park and C. B. Schrader, “Can an input shaper with two impulses
inequality: suppress nonlinear residual vibrations?,” in Proc. 2003 American Control
Conf., 2003, pp. 3172–3177.
|ek +1 | < cM max(|ek |, |ek −1 |) (37) [19] T. Singh and S. R. Vadali, “Robust time-delay control,” Trans. ASME, J.
Dyn. Syst. Meas. Control, vol. 115, no. 2, pp. 303–306, 1993.
where cM is a maximum value among all cj s for j = [20] W. H. Press, B. P. Flannery, S. A. Teukolsky, and W. T. Vetterling, Numer-
2, 3, . . . , ∞. By using (37), |ej | for j = 2, 3, 4, . . . , k is rep- ical Recipes in C, The Art of Scientific Computing. Cambridge, U.K.:
Cambridge Univ. Press, 1988.
resented as follows: [21] L. W. Johnson and R. D. Riess, Numerical Analysis, 2nd ed. Reading,
MA: Addison-Wesley, 1982.
|e2 | < cM eM
|e3 | < cM max(|e1 |, |e2 |) < cM eM
Juyi Park (M’02) received the B.S. degree in pro-
.. duction engineering the M.S. degree in precision en-
. gineering, and the Ph.D. degree in mechanical engi-
neering from the Korea Advanced Institute of Science
|ek | < ckM−2 eM and Technology (KAIST), Daejon, Korea, in 1991,
1993, and 2001, respectively.
where eM = max(|e0 |, |e1 |). As a result, He was a Postdoctoral Fellow at the University
of Texas at San Antonio from 2001 to 2002. From
lim |ek | < lim ckM−2 eM = 0. (38) 2002 to 2004, he was a Research Associate in the
k →∞ k →∞ Department of Electrical Engineering and Computer
Science, Vanderbilt University, Nashville, TN. Since,
In other words, pk converges to pn as iteration proceeds. 2004, he has been working on intelligent robot controllers at the Robot R&D
Institute, Daewoo Shipbuilding and Marine Engineering Company Ltd., Koje
City, Korea. His research interests are suppression of residual vibration in flex-
ible structures, robots for disabled people, and real-time robot controllers.
REFERENCES
[1] H. Asada, Z.-D. Ma, and H. Tokumaru, “Inverse dynamics of flexible robot
arms of trajectory control,” in Proc. Modeling and Control of Robotic Pyung-Hun Chang (S’86–M’89) was born in Pusan,
Manipulators, 1987 ASME Winter Annu. Meeting, 1987, pp. 329–336. Korea, in 1951. He received the B.S. and M.S. de-
[2] P. T. Kotnik, S. Yurkovich, and U. Ozguner, “Acceleration feedback for grees from Seoul National University (SNU), Seoul,
control of a flexible manipulator arm,” J. Robot. Syst., vol. 5, no. 3, Korea, in 1974 and 1977, respectively, and the Ph.D.
pp. 181–196, Jun. 1988. degree from the Massachusetts Institute of Technol-
[3] N. C. Singer and W. P. Seering, “Preshaping command inputs to reduce ogy (MIT), Cambridge, MA, in 1987, all in mechan-
system vibration,” Trans. ASME, J. Dyn. Syst. Meas. Control, vol. 112, ical engineering.
pp. 76–82, 1990. From 1984 to 1987, he was involved in a research
[4] M. Ballesteros and W. Book, “Implementation alternatives for dual rate project in the field of robotics as a Research Assis-
control systems with command shaping,” in Proc. American Control Conf., tant at the Artificial Intelligence Laboratory of MIT.
2002, pp. 2285–2291. Since 1987, he has been on the faculty of and is now a
PARK et al.: INPUT SHAPING TECHNIQUE FOR AN INDUSTRIAL ROBOT 65
Professor in the Department of Mechanical Engineering, Korea Advanced Insti- Eunjeong Lee (S’88–M’94) received the B.S. de-
tute of Science and Technology (KAIST), Daejon, Korea. His research interests gree from Ajou University, Suwon, Korea, in 1986,
are high accuracy/speed control with application to mechanical systems, robust the M.S. degree from Northwestern University,
control of nonlinear plants such as robot manipulators, and task-oriented design Evanston, IL, in 1989, and the Ph.D. degree from
of robot manipulators. Case Western Reserve University, Cleveland, OH, in
1994, all in mechanical engineering.
She is currently a Visiting Professor in the Depart-
ment of Electrical Engineering and Computer Sci-
ence at the Korea Advanced Institute of Science and
Hyung-Soon Park was born in Seoul, Korea, in Technology (KAIST), Daejon, Korea. She was an
1972. He received the B.S. degree in precision en- Assistant Professor in the Department of Mechanical
gineering and the M.S. and Ph.D. degrees in mechan- Engineering at the University of Texas at San Antonio from 2000 to 2002. Her
ical engineering from the Korea Advanced Institute research interests are biomimetics at the micro/nanoscale, MEMS, intelligent
of Science and Technology (KAIST), Daejon, Korea, control, and superconducting renewable evergy systems.
in 1994, 1996, and 2004, respectively. Dr. Lee received a University of Houston/NASA Johnson Space Cen-
He is currently a Research Associate at the Re- ter Aerospace Postdoctoral Fellowship (1996–1999) and the Workshop Ma-
habilitation Institute of Chicago, Chicago, IL. His terial/Product Performance Award from the 1997 International Workshop on
research interests include robust control algorithms, Superconductivity. She served the IEEE Control Stytems Society as an Asso-
design and control of rehabilitation robots, and tele- ciate Editor for the Conference Editorial Board from 2000 to 2002. She is also
operation systems. a member of ASME.