Kim 2000
Kim 2000
                                                                              Ji-Yoon Kang
                                                                              Electro Mechanics Laboratory
                                                                              Samsung Advanced Institute of Technology
                                                                              P.O. Box 111
                                                                              Suwon, 440-600, Korea
                                                                              Kyo-Il Lee
                                                                              Department of Mechanical Design and
                                                                              Production Engineering
                                                                              Seoul National University
                                                                              San 56-1, Shinlim-dong, Kwanak-gu
                                                                              Seoul, 151-742, Korea
                     The focus of this work is on a robust tracking control design for a 6 DOF parallel
                     manipulator in the presence of nonlinearity and fast Žor slowly. time-varying uncer-
                     tainty. Two types of controllers are presented. The controls are based on the Lyapunov
                     approach and guarantee a practical stability. The controls utilize the information of
                     link displacements and its velocities. The first control scheme uses the quadratic
                     Lyapunov function and other uses the geometry dependent Lyapunov function, which
                     excludes the inverse matrix computation on the inertia matrix. Also, the hydraulic
                     dynamics is considered in the control design and control performance. The control
                     performances of the proposed algorithms are verified by simulations and experiments.
                     䊚 2000 John Wiley & Sons, Inc.
can manage the dynamics based on both on the                  at the base platform and a body-fixed frame Ž oxyz .
linkspace and the workspace.                                  at the top platform. The 12 joints’ coordinates are
                                                              denoted as follows:
II. DYNAMIC MODEL OF A 6 DOF
PARALLEL MANIPULATOR
                                                                    Pi P , i s 1, 2, . . . , 6: platform joint vector in
We represent the coordinates of a 6 DOF motion                                            body-fixed frame
with the inertial frame and the body-fixed frame
attached to the moving platform ŽFig. 1.. The 6 DOF            Bi , i s 1, 2, . . . , 6: base joint vector in inertial frame
motions are linear and angular motions. Linear mo-
tions consist of the longitudinal Žsurge., lateral            If the rotational transformation matrix and the
Žsway., and vertical Žheave. motion. Angular mo-              translation vector are represented by R ␣ ␥ and D,
tions are Euler angles whose rotational sequences             respectively, the relative vector of ith joint is writ-
are x-axis, y-axis, and z-axis. Here, we denote q as          ten as
the 6 DOF displacement vector of which elements
are surge Ž u., sway Ž v ., heave Ž w ., roll Ž ␣ ., pitch
Ž  ., and yaw Ž␥ ..                                                            l i s R ␣ ␥ Pi P q D y Bi                 Ž2.
            qs u      v   w     ␣       ␥
                                             T
                                                 .    Ž1.     Thus, we can compute the link lengths, i.e., norms
                                                              of l i , from the given positions and orientations of
                                                              the platform. This problem is called an inverse kine-
    In this article, we use the following notations in        matics problem of a parallel manipulator. The forward
the model of the parallel manipulator. Referring              kinematics problem is the opposite of the inverse
again to Figure 1, we fixed an inertial frame Ž OXYZ .        kinematics, i.e., to obtain the positions and orienta-
tions from the given actuator lengths. The solution                              2. Uniform boundedness: Given any constant r )
of forward kinematic problem can be analytically                                    0 and any solution  Ž⭈.: w t 0 , ⬁. ª R n ,  Ž t 0 . s
represented as that of a 16th or 40th order polyno-                                  0 of Ž4. with 5  0 5 F r , there exists d Ž r . ) 0
mial.14 However, it does not mean that it can be                                    such that 5  Ž t .5 F d Ž r . for all t g w t 0 , ⬁..
solved analytically. Thus, we usually rely on nu-                                3. Uniform ultimate boundedness: Given any con-
merical solutions such as the Newton᎐Rhapson                                        stant d ) d and any r g w 0, ⬁., there exists
method 4 in order to solve the forward kinematics
                                                                                    a finite time T Ž d , r . such that 5  0 5 F r
problem and to obtain the 6 DOF information of the
upper platform. Or an estimator design for forward                                  implies 5  Ž t .5 F d for all t G t 0 q T Ž d , r ..
kinematics can be utilized.15                                                    4. Uniform stability: Given any d ) d , there ex-
    There are several dynamics models of a 6 DOF                                    ists a ␦ Ž d . ) 0 such that 5  0 5 F ␦ Ž d . im-
parallel robot.19 ᎐ 21 We modified the dynamic model                                plies 5  Ž t .5 F d for all t G t 0 .
of a 6 DOF parallel manipulator to account for the
inherent uncertainty in the system as follows:
                                                                                  In this article, the norm is Euclidean and the
                                                                             matrix norm is an induced norm. Thus, 5 ⌸ 5 2 s
    M Ž q,  . q¨q C Ž q, q,
                          ˙  . q˙q G Ž q,  . s J T Ž q . u Ž3.             ma x Ž ⌸ T ⌸ ., where ⌸ is a real matrix. minŽmax.Ž ⌸ .
Here, q represents the displacement vector as shown                          stands for the minŽmax. eigenvalue of the desig-
in Ž1.. M Ž⭈. is the inertia matrix, C Ž⭈. is the Coriolis                   nated matrix ⌸.
and centrifugal force, GŽ⭈. is the gravitational force,
J Ž⭈. is the Jacobian matrix, and u g R 6 is the general-
ized actuator force at each actuator.  Ž⭈. Žconstant
                                                                             III. ROBUST CONTROL BASED ON LINKSPACE
or time-varying. denotes the uncertain parameter
                                                                             COORDINATES (QUADRATIC LYAPUNOV
vector. The detail elements of M Ž⭈., C Ž⭈., GŽ⭈., and
                                                                             FUNCTION ANALYSIS)
J Ž⭈. are given in the Appendix.
      The main focus of this article is to design a                          A parallel root consists of a top plate and six links
controller to guarantee a high control performance                           Žcylinders.. The control task for the position and
in the presence of uncertainty. Here, we put an                              orientation of the top plate to track the desired
assumption regarding to the uncertainty.                                     values may require the information of the top plate’s
                                                                             position and orientation. This is from the fact that
Assumption 1: The uncertain parameter vector is such                         the control scheme usually utilizes the dynamics
that  g ⌺ ; R o , where ⌺ is prescribed and compact.                        represented by the displacement vector q. That kind
                                                                             of control scheme was defined as a workspace-con-
    Next, for the stability analysis we introduce the                        trol as stated early. To obtain this information we
practical stability. We consider the following class                         need to compute the forward kinematics or to in-
of uncertain dynamical systems                                               stall an expensive 6 DOF sensor mounting on the
                                                                             platform. In case of a parallel manipulator, we may
            ˙Ž t . s f Ž  Ž t . ,  Ž t . , t . ,    0 s  Ž t0 .   Ž4.   not be able to adopt a feasible analytic solution of
                                                                             forward kinematics, which is dedicated to obtaining
where t g R is the time,  Ž t . g R n is the state,                         the position and velocity information of the upper
 Ž t . g R o is the uncertainty, and f Ž  Ž t .,  Ž t ., t . is           platform. Therefore, we should rely on a numerical
the system vector.                                                           method even if it does not guarantee an exact value
                                                                             of the platform information, in which it sometimes
Definition 1: The uncertain dynamical system Ž4. is                          requires much computation effort. Thus, the control
practically stable iff there exists constant d ) 0 such                     design using the upper platform information has a
that for any initial time t 0 g R and any initial state                      limitation to the real time application. Hence, it is
 0 g R n , the following properties hold.                                   necessary to design a control scheme based on the
                                                                             information on link lengths and velocities. The con-
      1. Existence and continuation of solutions: Given                      trol was early defined as a linkspace Žjointspace.
         Ž  0 , t 0 . g R n = R, system Ž4. possesses a so-                 coordinates control. The control designs directly
         lution  Ž⭈.: w t 0 , t 1 . ª R n ,  Ž t 0 . s  0 , t 1 ) t 0 .   stem from the dynamics constructed by the link-
         Furthermore, every solution  Ž⭈.: w t 0 , t 1 . ª                  space coordinates.4,5 However, the dynamics em-
         R n can be continued over w t 0 , ⬁..                               ployed in the control design uses the approximated
                                                                  Kim, Kang, and Lee: Robust Tracking Control Design                        䢇
                                                                                                                                                  531
model. Here, considering the full dynamics, we pro-                   puted from the neutral position Ž q s 0. and the
pose a control scheme based on linkspace coordi-                      unknown term as
nates by transforming the dynamics written by the
workspace coordinates into dynamics by the link-                              My1
                                                                               1
                                                                                  Ž q,  . s My1
                                                                                              1
                                                                                                 Ž 0,  . q ⌬ My1
                                                                                                               1
                                                                                                                  Ž q,  .                        Ž 12 .
space coordinates. Furthermore, the proposed con-
trol is designed to be robust to the uncertainty.                     where  g R p ; ⌺ represents the nominal value of
     The new dynamic equation on the linkspace                        parameter vector and ⌬ My1  1
                                                                                                    Ž⭈. represents the uncer-
starts from the following property by using the                       tain portion. Then, Ž11. is written as
Jacobian matrix J Ž⭈..
                                                                      ¨e s My1       y1 Ž
                                                                            1 u q ⌬ M1    q,  . u q  Ž q, q,
                                                                                                            ˙ e, ˙e, ˙y d , ¨y d ,  .
                               y1 Ž
                         q˙s J        q. ˙
                                         y                    Ž5.                                                                                 Ž 13 .
where ˙y g R 6 is the six link velocity vector. Then,
we construct a new dynamic equation on the link-                      where
space coordinates:
                                                                           Ž q, q,
                                                                                 ˙ e, ˙e, ˙y d , ¨y d ,  .
      M1Ž q,  . ¨          ˙  . ˙y q G1Ž q,  . s u
                 y q C1Ž q, q,                                Ž6.
                                                                                        ¨ d y My1
                                                                                     [ yy      1
                                                                                                  Ž q,  . C Ž q, q,
                                                                                                                  ˙  .Ž ˙e q ˙y d .
where                                                                                    y My1
                                                                                            1
                                                                                               Ž q,  . G1Ž q,  .                                Ž 14.
M1Ž q,  . s JyT Ž q . M Ž q,  . Jy1 Ž q . Ž7. Also, we express Ž13. in the state space form as
              ˙  . s JyT Ž q . M Ž q,  . J˙y1 Ž q .
       C1Ž q, q,
                                                                                                             ˙ ˙y d , ¨y d ,  . Ž15.
                                                                         ˙z s Az q Bu q ⌬ Bu q ⌽ Ž e, ˙e, q, q,
                        q JyT Ž q . C Ž q, q,
                                           ˙  . Jy1 Ž q .    Ž8.
                                                                      Here,
                                 yT
               G 1Ž q,  . s J        Ž q . G Ž q,  .        Ž9.
                                                                                e                     0    I                      0
Here, y g R 6 represents the six link displacement                       zs                  As                       Bs
                                                                                ė                    0    0                  My1
                                                                                                                               1
                                                                                                                                  Ž 0,  .
vector. y and ˙ y can be measured directly through a
linear displacement sensor. These signals are dedi-                                                 0                                      0
cated to the controller design.                                          ⌬ B Ž q,  . s                                    ⌽ Ž⭈. s
                                                                                               ⌬ My1
                                                                                                  1
                                                                                                     Ž q,  .                              Ž⭈.
    Define the tracking error e g R 6 and its deriva-
     e g R 6 in the sense of actuator,
tive ˙                                                                                                                                            Ž 16 .
Here, we can choose the function  Ž⭈. such that it                                Now, we show the stability and boundedness of
has a dependency on e and ˙  e only. This is possible                              that control law through Theorem 1.
since q˙ can be transformed into ˙e by the Jacobian
J Ž q . whose norm can be bounded by a constant                                    Theorem 1: Subject to Assumptions 1 and 2, the sys-
value, and the platform displacement q can be                                      tem Ž15. is practically stable under the control Ž24..
bounded by a constant within the specified work-
space.                                                                             Proof: See Appendix section II.
       For the next process for designing a robust
control, we consider another assumption which em-                                  Remark 1: The condition on the input uncertainty
ploys the condition imposed on the input uncer-                                    shown in Ž22. is limited in applying to a practical
tainty.                                                                            use. However, this can be relaxed by the following
                                                                                   condition by showing the possible range of the
Assumption 2: There exists  E Ž q . for all q g R 6 such                          input uncertainty extends to certain range as fol-
that                                                                               lows:
   Next, let another bounding function  Ž⭈.: R 6 =                                First, when 5  5 ) ⑀ , the last term of Ž58. becomes
R ª Rq be chosen such that
 6
                                                                                       T Ž p q Ep q h .
                                            1                                                          y                               
                Ž e, ˙
                      e. G                              Ž e, ˙
                                                              e.          Ž 23.             s T                    q T yE                 q5 5 
                                     1 y E Ž q .                                                  ž   5 5         / ž             5 5     /
Now, we construct a robust control u g R 6 as                                               F y5  5  y  E 5  5  q 5  5Ž 1 q  E . 
                                                                                            s0                                                           Ž 30 .
                                                          e
u s yKz q p Ž e, ˙
                 e. s y K p                       Kv         q p Ž e, ˙
                                                                      e . Ž 24 .
                                                          ė                           Second, when 5  5 F ⑀ , the last term of Ž58.
                                                                                   becomes from the inequality property used in Ž60.,
Here, K = R 6= 12 , whose elements are K p g R 6= 6 and
K v g R 6= 6 , is chosen such that AŽs A y BK . is Hur-                                 T Ž p q Ep q h .
witz. Thus, there exists a symmetric and positive                                                          
definite matrix P satisfying                                                                  F T y  2 y E  2 q 5  5 
                                                                                                       ž                            /
                                                                                                       ⑀    ⑀
               PA q A T P s yQ,                          Q)0              Ž 25 .                       Ž1 q  E .
                                                                                             Fy                       5  5 2 2 q 5  5 
                                                                                                               ⑀
Also, as hinted in ref. 13, pŽ⭈. g R 6 can be taken as
                                                                                                       Ž1 q  E .
              ¡y      Ž e, ė .
                                  Ž e, ˙
                                        e.                  if  Ž e, ˙
                                                                      e. ) ⑀
                                                                                             Fy
                                                                                                               ⑀
                                                                                                                      5  5 2  2 q  Ž1 q  E . 5  5
       e. s
p Ž e, ˙   ~          Ž e, ė .
                                                                                             F
                                                                                                 Ž1 q  E . ⑀
                                                                                                                                                         Ž 31 .
                    Ž e, ė .
              ¢y
                                                                                                           4
                                    2Ž
                                          e, ˙
                                             e.             if  Ž e, ˙
                                                                      e. F ⑀
                       ⑀                                                                Thus, the system with different input uncer-
                                                                          Ž 26 .   tainty constraint Ž  E ) y1., which is more practical
                                                                                   than the constraint in Ž22., also guarantees the prac-
                            Ž e, ˙
                                  e . s B T Pz                            Ž 27 .   tical stability.
                                                                                Kim, Kang, and Lee: Robust Tracking Control Design                    䢇
                                                                                                                                                          533
IV. A MODIFIED ROBUST CONTROL SCHEME                                                The bounding function  1Ž⭈. can also be a function
(GEOMETRIC BASED LYAPUNOV FUNCTION)                                                 of e and ˙ e by the geometric boundedness as men-
                                                                                    tioned in section III.
Since the control proposed in section III utilizes the                                  For the proof of the skew-symmetric property of
inverse matrix My1 Ž⭈. to compute the bounding                                      Ṁ1 y 2C1 , we introduce the following lemmas. Here,
function  Ž⭈., a problem in the real time application                              Lemma 1 is adopted from ref. 2, and Lemma 2 is
due to the computational burden occurs. Here, an                                    partially adopted from ref. 16.
alternative control type is proposed instead. The
control stems from the different Lyapunov function                                  Lemma 1: 2 Ž1. The matrix M is positive definite and
compared to that adopted in section III. The another                                                   ˙ y 2C satisfies a skew-symmetric
                                                                                    symmetric. Ž2. The M
assumption is imposed to design the different type                                  property.
of robust control.
                                                                                    Lemma 2: Ž1. The matrix M1 is positive definite and
Assumption 3: There exist positive constants  and                                                    ˙1 y 2C1 satisfies a skew-symmetric
                                                                                    symmetric. Ž2. The M
such that                                                                           property.
                                 ¡y         1Ž e, ė .
                                                         Ž e, ė .
                                                                                               s JyT Ž M
                                                                                                       ˙ y 2C . Jy1 q
                                                                                                                                 d
                                                                                                                                 dt
                                                                                                                                      Ž JyT . MJy1
                                            1Ž e, ė . 1
                                                                                                             d
                                                                                                  y JyT M         Ž Jy1 .
                 e . g R6 s
         p 1Ž e, ˙               ~
                                if  1Ž e, ˙   e. ) ⑀1
                                                                         Ž 34 .                              dt
                               1Ž e, ė .
                            y               1Ž e, ė .                                                                     d
                                  ⑀1                                                                  ˙ y 2C . w q
                                                                                               s wT Ž M                          Ž w T . Mw y w T Mẇ
                                 ¢         if  1Ž e, ˙
                                                      e. F ⑀1
                                                                                                                            dt
                                                                                                                                                          Ž 40 .
              1Ž e, ˙              e .  1Ž e, ˙
                     e . s Ž e q S1 ˙           e . g R6                 Ž 35.      where w s Jy1 , For any vector x g R 6 , we can ex-
                                                                                    press
 K p 1 [ diag w K p 1 i x 6= 6           K p1 i ) 0       i s 1, 2, . . . , 6
                                                                         Ž 36 .           ˙1 y 2C1 . x s x T w T Ž M˙ y 2C . wx q x T w
                                                                                     xT Ž M                                           ˙ T Mwx
 K v 1 [ diag w K v 1 i x 6= 6           K v1 i ) 0       i s 1, 2, . . . , 6                              y x T w T Mwx
                                                                                                                      ˙
                                                                         Ž 37 .                         s xT w
                                                                                                             ˙ T Mwx y x T w T Mwx
                                                                                                                                ˙                         Ž 41 .
                                                                                    Using Lemma 1, and seeing that x T w
                                                                                                                       ˙ T Mwx is a
Here,  1Ž⭈.: R 6 = R 6 ª Rq is a bounding function                                                   ˙ Mwx s x w Mwx,
                                                                                                     T T
                                                                                    scalar and thus x w        T T
                                                                                                                   ˙ we have
computed from
                                                                                                            ˙1 y 2C1 . x s 0
                                                                                                       xT Ž M                                             Ž 42 .
              1 Ž q, q,
                      ˙ e, ˙e, q˙ , q¨ ,  . F  1Ž e, ˙e .
                                     d    d                              Ž 38.      Hence, M1 s JyT MJy1 satisfies a skew-symmetric
                                                                                    property.
where
                                                                                    Theorem 2: Subject to Assumptions 1, 2, and 3, the
     1Ž ⭈ . s yM1Ž q,  . Ž ¨
                             y d y S1 ˙
                                      e.                                            system Ž15. is practically stable under the control Ž33..
                        ˙  .Ž ˙y d y S1 e . y G1Ž q,  . Ž39.
               y C1Ž q, q,                                                          Proof: See Appendix section III.
534    䢇
             Journal of Robotic Systems—2000
                                                                                                                                   2
Remark 4: For time-varying uncertainty, the skew-
symmetry property on M    ˙1 y 2C1 does not hold any-
more. However, the control can be manipulated by
                                                                                              = x v i sign Ž Ps y P1 i .     (     
                                                                                                                                       < Ps y P1 <
                                                                                                                                                 i
                                                                                                                                                         Ž 45 .
                                                                                                     1
                         T                                                         Q3 i s y C d w Ž 1 y sign Ž x v i . .
  V˙1 s Ž ˙
          e q S1 e .         ž M S ˙e y M
                                1 1          1   ¨y d y C1 ˙y d q C1 S1 e                  2
                     ˙1 ˙e q M˙1 S1 e
           yG1 q u q M                                                                                                             2
           qe   TŽ
                     K p 1 q S1 K v 1 . ė
                                                  /                                           = x v i sign Ž Ps y P2 i .      (    
                                                                                                                                       < Ps y P2 <
                                                                                                                                                     i
                         T
                                                                                              1
      s Ž˙
         e q S1 e .          ž M S ˙e y M
                                1 1          1   ¨y d y C1 ˙y d q C1 S1 e          Q4 i s           C d w Ž 1 q sign Ž x v i . .
                                                                                              2
                 ˙1 ˙e q M˙1 S1 e q p 2
           yG1 q M                                    /                                                                            2
           y e T S1 K p 1 e y ˙
                              eT K v 1 ˙
                                       e
                                                                                              = x v i sign Ž P2 i y Pr .     (     
                                                                                                                                       < P2 y Pr <
                                                                                                                                           i
                   T
         e q S1 e . Ž  2 q p 2 . y e T S1 K p 1 e y ˙
      s Ž˙                                           eT K v 1 ˙
                                                              e Ž 43.
                                                                            where Q1 i , . . . , Q4 i are flow rate in the servovalve
                                                                            connected to the ith cylinder as shown in Figure 5.
where  2 [ M1 S1 ˙   e y M1 ¨
                             y d y C1 ˙
                                      y d q C1 S1 e y G 1 q                 Then, we can get the net flow rate between the
 ˙
M1 ˙      ˙
     e q M1 S1 e. The bounding function of  2 , which                      servovalve and the chamber of cylinder:
is expressed by  2 Ž⭈., can also be computed. The
 2 Ž⭈. can be taken in the controller p 1Ž⭈. with the
new bounding function  2 Ž⭈..                                                       Q A i s Q1 i q Q 2 i                Q B i s Q3 i q Q4 i .           Ž 46 .
                                                                                                                                                  Kim, Kang, and Lee: Robust Tracking Control Design                                  䢇
                                                                                                                                                                                                                                          535
The integration of the following continuity equation                                                                                                  For a positive constant , choose x v i as follows:
will give the pressure rate at each chamber:
                                V1 i dP1 i                                                       dx p i                                                                             1                           P1 i       P2 i
                                                   dt
                                                                 s Q A i y A1 i
                                                                                                  dt
                                                                                                                                             Ž 47 .        x vi s
                                                                                                                                                                     K qi
                                                                                                                                                                             ž     1
                                                                                                                                                                                 V1 i
                                                                                                                                                                                        y
                                                                                                                                                                                              1
                                                                                                                                                                                             V2 i
                                                                                                                                                                                                      ž/ ž
                                                                                                                                                                                                         2
                                                                                                                                                                                                                V1 i
                                                                                                                                                                                                                       q
                                                                                                                                                                                                                           V2 i   /
                            V2 i dP2 i                                                            dx p i
                                                             s yQ B i q A 2 i                                                                Ž 48 .
                                               dt                                                   dt                                                                                      
where  is the bulk modulus, A i is the ith cylinder
area, and V1 i , V2 i are each chamber volume. Then,
                                                                                                                                                                    q
                                                                                                                                                                        ž   V1 i
                                                                                                                                                                                   A21 i q
                                                                                                                                                                                             V2 i         / x p i q  e2 i q ˙
                                                                                                                                                                                                      A22 i ˙                d i
                                                                                                                                                                                                                                      /   Ž 52 .
               Figure 7. Simulation results of the tracking histories of 6 DOF motions with PD control.
                                       Kim, Kang, and Lee: Robust Tracking Control Design   䢇
                                                                                                539
Figure 8. Simulation results of the tracking histories of 6 DOF motions with robust
control Žtype I..
540   䢇
          Journal of Robotic Systems—2000
               Figure 9. Simulation results of the tracking histories of 6 DOF motions with robust
               control Žtype II..
                                      Kim, Kang, and Lee: Robust Tracking Control Design   䢇
                                                                                               541
Figure 10. Experimental results of the tracking histories of 6 DOF motions with PD
control.
542   䢇
          Journal of Robotic Systems—2000
               Figure 11. Experimental results of the tracking histories of 6 DOF motions with robust
               control Žtype I..
                                                                                      Kim, Kang, and Lee: Robust Tracking Control Design                   䢇
                                                                                                                                                                 543
to a serial robot but the control needs to be of                                              the geometry of the manipulator is introduced. The
a different form. The control schemes based on                                                control provides an efficient control scheme by ex-
linkspace coordinates are introduced and the perfor-                                          cluding the necessity of computing My1 Ž⭈. for the
mances are verified via simulations and experi-                                               computation of the bounding function that may
ments. The linkspace-control design starts from the                                           cause a computational burden. Both proposed con-
dynamics on the workspace coordinates and utilizes                                            trols rely on the possible bound of the uncertainty.
the dynamics on the linkspace coordinates after                                               The control design considering the hydraulic dy-
transforming the workspace dynamics to the link-                                              namics is proposed even though the control perfor-
space dynamics. A robust control based on the                                                 mance via simulation or experiment is not verified
quadratic Lyapunov function is introduced. The                                                yet at this stage. This leaves further investigation.
control handles the time-varying uncertainty and
does not limit a robot type whether it is revolute or
prismatic. However, it uses My1 Ž⭈. computation
and limits the input uncertainty to be within some                                            APPENDIX
constant. On the contrary, a robust control based on
the different Lyapunov function which depends on                                              I. Matrices in 6 DOF Parallel Robot Modeling 2
                                 m                 0           0                       0                                 0                 0
                                 0                 m           0                       0                                 0                 0
                                 0                 0           m                       0                                 0                 0
                         MŽ q. s 0                 0           0        I x C C␥ q I y C2 S␥2 q Iz S2
                                                                             2 2                              Ž I x y I y . C C␥ S␥     Iz S
                                          0          0         0              Ž I x y I y . C C␥ S␥             I x S␥2 q I y C␥2        0
                                          0          0         0                      Iz S                             0                 Iz
                                          0     0          0                  0                         0                            0
                                          0     0          0                  0                         0                            0
                                          0     0          0                  0                         0                            0
                       C Ž q, q˙. s 0           0          0            K 1 ˙q K 2 ␥
                                                                                    ˙            ˙ q K 5 ˙q K 3 ␥˙
                                                                                              K1 ␣                             ˙ q K 3 ˙
                                                                                                                            K2 ␣
                                          0     0          0                ˙ q K 3 ␥˙
                                                                       yK 1 ␣                          K 4␥
                                                                                                          ˙                    ˙ q K 4 ˙
                                                                                                                            K3 ␣
                                          0     0          0            ˙ y K 3 ˙
                                                                   yK 2 ␣                            ˙ y K 4 ˙
                                                                                                yK 3 ␣                               0
Jacobian J also
s T Ž p q Ep q h . ⑀
                F       T
                             ž   y
                                      
                                     5 5
                                             q 5  5 E  q 5  5 
                                                /
                                                                                                                         Rzs       (       
                                                                                                                                                                     Ž 65 .
                             ¡
                                                                                                   where
                                                                         min Ž P .
                             ~␥
                                  0              if r z F d z    (       ma x Ž P .
                                                                                                         1 [ 12 min min min Ž ⍀ 1 i . , i s 1, 2, . . . , 6
                                                                                                                      i
                                                                                                                               ½    g⌺
                                                                                                                                                                                          5       Ž 73 .
      Tz Ž d z , r z . s                   Ž r z . y Ž ␥ 1 (␥y1                         Ž 67 .
                                                             2 (␥ 1
                                       2
                                                                    .Ž d .                            Next, with respect to the bound from the above
                                                                                                   condition in Assumption 2,
                             ¢                   Ž ␥ 3 (␥y1
                                                         2 (␥ 1
                                                 otherwise
                                                                .Ž d .
                                                                                                           V1 F 12  5 ˙
                                                                                                                       e q S1 e 5 2 q 12 e T Ž K p 1 q S1 K v 1 . e
                                      ␦z Ž d z . s R z                                  Ž 68 .                                 6
                                                                                                              s 12           Ý Ž ˙e i2 q 2 S1 i ˙e i e i q S12i e i2 .
where ␥ 1Ž z . s minŽ P .5 z 5 , ␥ 2 Ž z . s max Ž P .5 z 5 ,
                         1
                         2
                                                      2                    1
                                                                           2
                                                                                           2
                                                                                                                          is1
␥ 3 Ž5 z 5. s  5 z 5 2 , d z s ␥y1    Ž .           y1
                                 1 (␥ 2 R z , R z s ␥ 2 (␥ 1 d z .
                                                            Ž .                                                                    6
                                                                                                                     q 12      Ý Ž Kp               1i
                                                                                                                                                         q S1 i K v 1 i . e i2
                                                                                                                               is1
III. Proof of Theorem 2
                                                                                                                          6                                       ei
Define Lyapunov function candidate V1 as                                                                      s 12        Ý            ei       ė i ⍀ 1 i                                        Ž 74 .
                                                                                                                      is1
                                                                                                                                                                  ė i
                             T
 V1 s 12 Ž ˙
           e q S1 e . M1Ž ˙
                          e q S1 e . q 12 e T Ž K p 1 q S1 K v 1 . e                               where
                                                                                        Ž 69 .
                                                                                                                                S1i2 q K p 1 i q S1i K v 1 i                     S1 i
                                                                                                            ⍀1i [                                                                                 Ž 75 .
To see that V1 is a legitimate Lyapunov function                                                                                                     S1 i                         
candidate, we shall prove that V1 is positive defi-
nite and decrescent. By Assumption 2, it can be seen                                               Therefore, we have
that
                                                                                                                                        6
        V1 G  5 ˙
                1
                2e q S1 e 5 q e Ž K p 1 q S1 K v 1 . e
                                             2        1 T
                                                      2
                                                                                                                  V1 F 12              Ý max Ž ⍀ 1 i . Ž e i2 q ė i2 .
                                                                                                                                       is1
                         6
            s 12                                                                                                         F  2 5 z1 5 2                                                          Ž 76 .
                      Ý Ž ˙e12 q 2 S1 i ˙e i e i q S12i e i2 .
                      is1
                                                                                                   where
                             6
                q 12         Ý Ž Kp              q S1 i K v 1 i . e i2
                                            1i                                                         2 [ 12 max max max Ž ⍀ 1 i . , i s 1, 2, . . . , 6 . Ž 77.
                                                                                                                          ½                                                               5
                         is1                                                                                     i              g⌺
                     6                                    ei
            s 12                 ei        ė i ⍀ 1 i                                   Ž 70 .     The derivative of V1 along the trajectory of the
                    Ý                                     ė i                                     system Ž11. is given by
                    is1
                                                                                                                         T
where                                                                                                  V˙1 s Ž ˙
                                                                                                               e q S1 e . M1Ž ¨
                                                                                                                              e q S1 ˙
                                                                                                                                     e.
                                                                                                                                                T
                          S12i q K p 1 i q S1 i K v 1 i                    S1 i                             q 12 Ž ˙          ˙1Ž ˙e q S1 e .
                                                                                                                     e q S1 e . M
          ⍀1i [                                                                         Ž 71.
                                             S1 i                                                           q e T Ž K p 1 q S1 K v 1 . ė
                                                                                                                                   T
where e i and ˙e i are the ith components of e and ˙   e,                                                  s Ž˙
                                                                                                              e q S1 e .                Ž M1 S1 ˙e y M1 ¨y d y C1 ˙y d y C1 ˙e
respectively. For the sake of not arising confusion,
we introduce a state variable z 1 s w e ė x T even if it                                                     yG1 q u . q e T Ž K p 1 q S1 K v 1 . e
546    䢇
             Journal of Robotic Systems—2000
             q 12 Ž ˙
                    e q S1 e . M
                                 T
                               ˙1Ž ˙e q S1 e .                                          Ž 78 .   Following Ž82. for r z 1 ) 0, if 5 z 1 0 5 F r z 1, we can sat-
                                                                                                 isfy the requirements of the practical stability 13 with
According to Ž33., Ž39., and the skew-symmetric                                                  the uniform boundedness Žball size of d z 1Ž r z 1 .., the
            ˙1 y 2C1 shown in Lemma 2, it can be
property on M                                                                                    uniform ultimate boundedness Žball size of d z 1 ) d z 1
seen that
                                                                                                 and a finite escaping time Tz 1Ž d z 1, r z 1 .., and the uni-
   V˙1 s Ž ˙
           e q S1 e .
                        T
                       Ž M1 S1 ˙e y M1 ¨y d y C1 ˙y d q C1 S1 e                                  form stability Žball size of ␦ z 1Ž d z 1 ..
                                                                                                                      ~¡Ž ␥
            yG1 q p 1 . y e T S1 K p e y ˙
                                         eT K v ˙
                                                e                                                                             y1
                                                                                                                              4 (␥ 5                        if r z 1 F R z 1
                                           1                    1
                                                                                                                                     .Ž R z .
                                                                                                       d z 1Ž r z 1 . s
                                                                                                                       ¢
                                                                                                                                           1
                        T                           T                                                                                                                          Ž 86 .
         e q S1 e .  1 q Ž ˙
      F Ž˙                  e q S1 e . p 1                                                                                 Ž ␥4y1 (␥ 5 .Ž r z .             if r z 1 ) R z 1
                                                                                                                                             1
            y min Ž S1 K p 1 , K v 1 .Ž 5 e 5 2 q 5 ˙
                                                     e5 2 .                             Ž 79 .
                                                                                                                              ¡0                                1
If 5  1 5 ) ⑀ 1 , the first two terms in Ž79. become by
                                                                                                                                         if r z 1 F d z 1   (   2
the p 1 in Ž34.
                                                                                                           ž              / ~ ␥ Žr
                                                                                                       Tz 1 d z 1 , r z 1 s        5    z1
                                                                                                                                             . y Ž ␥4 (␥y1
                                                                                                                                                        5 ( ␥4
                                                                                                                                                               .Ž d .          Ž 87 .
                                                                                                                              ¢         Ž ␥6 (␥y1
                                                                                                                                               5 ( ␥4
             T                  T
   e q S1 e .  1 q Ž ˙
  Ž˙                  e q S1 e . p 1                                                                                                                  .Ž d .
                                                                                                                                         otherwise
                                                                 ˙e q S1 e
           F5˙
             e q S1 e 5  1 q Ž ˙
                                                    T
                                e q S1 e .                  y                
                                                        ž       5˙e q S1 e 5 1      /                                             ␦z1 d z1 s R z1
                                                                                                                                       ž /                                     Ž 88 .
           s0                                                                           Ž 80 .
                                                                                                 where ␥4Ž z 1 . s  1 5 z 1 5 2 , ␥ 5 Ž z 1 . s  2 5 z 1 5 2 , ␥6 Ž5 z 1 5. s
If 5  1 5 F ⑀ 1 , those become from the inequality prop-
erty of Ž60.                                                                                     1 5 z 1 5 2 , d z s ␥4y1 (␥ 5 Ž R z 1 ., R z 1 s ␥y1
                                                                                                                                                    5 ( ␥4 d z 1 .
                                                                                                                                                                Ž .
              T                  T
    e q S1 e .  1 q Ž ˙
   Ž˙                  e q S1 e . p 1                                                                 This paper is supported by the research fund of Seoul
                                                                                                      National University of Technology.
                                                                    ˙e q S1 e
            F5˙
              e q S1 e 5  1 q Ž ˙
                                                        T
                                 e q S1 e .                     y                    12
                                                            ž          ⑀1       /
                                     1                                                           REFERENCES
            s5˙
              e q S1 e 5  1 y            5˙
                                           e q S1 e 5 2 12
                                     ⑀1                                                           1. C. Nguyen, F. Pooran, and T. Premack, Control of
                ⑀1                                                                                   robot manipulator compliance, in Recent trends in
            F                                                                           Ž 81 .       robotics: Modeling, control, and education, M.
                4                                                                                    Jamshidi, J. Luh, and M. Shahinpoor ŽEditors., North-
                                                                                                     Holland, Amsterdam, 1986, pp. 237᎐242.
Therefore, V˙1 is bounded by                                                                      2. G. Lebret, K. Liu, and F. Lewis, Dynamic analysis and
                                                                                                     control of a Stewart platform manipulator, J Robotic
                                                                            ⑀1                       Syst 10 Ž1993., 629᎐655.
      V˙1 F ymin Ž S1 K p 1 , K v 1 .Ž 5 e 5 2 q 5 ˙
                                                    e5 2 . q                                      3. J.L. Overholt and A.A. Zeid, Partial state feedback
                                                                            4
                                                                                                     linearization based control for a Stewart platform ŽPart
            s y1 5 z 1 5 q ⑀ 1
                            2
                                                                                        Ž 82 .       I: Theory., 23th Summer Computer Simulation Conf,
                                                                                                     1991, pp. 512᎐517.
where                                                                                             4. C. Nguyen, S. Antrazi, Z. Zhou, and C. Campbell,
                                                                                                     Adaptive control of a Stewart platform-based manipu-
                                                                                                     lator, J Robotic Syst 10 Ž1993., 657᎐687.
                      1 [ min Ž S1 K p 1 , K v 1 .                                    Ž 83.
                                                                                                  5. R. Colbaugh, K. Glass, and H. Seraji, Direct adaptive
                                          ⑀1                                                         control of robotics systems, American Control Conf,
                                  ⑀1 [                                                  Ž 84.        1993, pp. 1138᎐1143.
                                           4                                                      6. K. Maeda, Time delay control of a 6 d.o.f. direct drive
                                                                                                     wrist joint using pneumatic actuators, Int Conf on
Thus, V˙1 - 0 for all 5 z 1 5 ) R z 1, where                                                         Advanced Robotics, 1993, pp. 159᎐164.
                                                                                                  7. D. Grant and V. Hayward, Design of shape memory
                                               ⑀1                                                    alloy actuator with high strain and variable structure
                                R z1 s   (     1
                                                                                        Ž 85 .       control, IEEE Int Conf on Robotics and Automation,
                                                                                                     1995, pp. 2305᎐2312.
                                                            Kim, Kang, and Lee: Robust Tracking Control Design    䢇
                                                                                                                      547
 8. P. Chiacchio, F. Pierrot, L. Sciavicco, and B. Siciliano,   15. J.Y. Kang, D.H. Kim, and K.I. Lee, Robust estimator
    Robust design of independent joint controllers with             design for forward kinematics solution of a Stewart
    experimentation on a high-speed parallel robots, IEEE           platform, J Robotic Syst 15 Ž1998., 30᎐42.
    Trans Ind Electron 40 Ž1993., 393᎐403.                      16. M. Zribi and S. Ahmad, Lyapunov based control of
 9. D. Dawson, Z. Qu, F. Lewis, and J. Dorsey, Robust               multiple flexible joint robots, American Control Con-
    control for the tracking of robot motion, Int J Control         ference, 1992, pp. 3324᎐3328.
    52 Ž1990., 581᎐595.
10. Z. Qu, Input᎐output robust control of flexible joint        17. D. Auslander, Realtime software for control, Prentice-
    robots, in Proceedings of IEEE Inter Conf of Robotics           Hall, New York, 1990.
    and Automation, Vol. 3, Atlanta, GA, 1993, pp. 1004᎐        18. H.E. Merritt, Hydraulic control systems, Wiley, New
    1010.                                                           York, 1967.
11. P. Begon, F. Pierrot, and P. Dauchez, Fuzzy sliding         19. B. Dasgupta and T.S. Mruthyunjaya, Closed-form dy-
    mode control of a fast parallel robot, IEEE Int Conf on         namic equations of the general Stewart platform
    Robotics and Automation, Vol. 3, 1995, pp. 1178᎐1183.           though the Newton᎐Euler approach, Mech Mach The-
12. J.Y. Kang, D.H. Kim, and K.I. Lee, Robust tracking              ory 33 Ž1998., 1135᎐1152.
    control of Stewart platform, Proc of the 35th Conf of       20. Z. Geng, L.S. Haynes, J.B. Lee, and R.L. Carroll, On
    Decision and Control, Kobe, Japan, 1996, pp. 3014᎐              the dynamic model and kinematic analysis of a class
    3019.                                                           of Stewart platform, Robot Autonomous Syst 9 Ž1992.,
13. M. Corless and G. Leitmann, Continuous state feed-
                                                                    237᎐254.
    back guaranteeing uniform ultimate boundedness for
    uncertain dynamic system, IEEE Trans Automat Con-           21. E.F. Fichter, A Stewart platform-based manipulator:
    trol 26 Ž1981., 1139᎐1144.                                      General theory and practical construction, Int J Robot
14. R. Nair and J. Maddocks, On the forward kinematics              Res 5 Ž1986., 157᎐181.
    of parallel manipulators, Int J Robot Res 13 Ž1994.,        22. D.H. Kim, Robust control design for flexible joint
    171᎐188.                                                        manipulators, Ph.D. thesis, Georgia Tech, 1995.