A DISCONTINUOUS CONTROL FOR ROBOTIC MANIPULATORS WITH COULOMB FRICTION

A DISCONTINUOUS CONTROL FOR ROBOTIC MANIPULATORS WITH COULOMB FRICTION

Copyright © 2002 IFAC 15th Triennial World Congress, Barcelona, Spain www.elsevier.com/locate/ifac $ ',6&217,18286 &21752/ )25 52%27,& 0$1,38/$7256 ...

557KB Sizes 1 Downloads 48 Views

Copyright © 2002 IFAC 15th Triennial World Congress, Barcelona, Spain

www.elsevier.com/locate/ifac

$ ',6&217,18286 &21752/ )25 52%27,& 0$1,38/$7256 :,7+ &28/20% )5,&7,21 -RDTXLQ $OYDUH] ,RXUL 2UORY 5RTXH 0DUWLQH]

6FLHQWL¿F 5HVHDUFK DQG $GYDQFHG 6WXGLHV &HQWHU RI (QVHQDGD &,&(6(  .P  &DUU 7LM(QV  (QVHQDGD %& 0H[LFR

  

  

               p                                        

               !             

    

     

                                     

   "     



                      

   !            

   

         ¿              Copyright © 2002 IFAC #       

 $     %           

            p                     "                     ) 0 HW DO 4555,                  1        ¿  )        , "           

          6            

    

     

  

& !'"%("!' "            

                                      

                                 )   &*++,     

       -   .        "  .              -   

      /         

 .  0     .     -      1   

      )$ 0   2  &**3, "  

          -     

     

 .           

   

                                   

   "     

                        

   6          



   

          ¿              6 

    -         4   5       

"   

              !              

         

  0         )'   &***, "                    

  

   

4 !$'"!'(($ 7'8! $7$"98$ 6                  -      

157

{b @ i +{,> q

"  

  1  {+w,  )&,        olpw$4 glvw+{+w,> , @ 3

)&,

q

  i = LU $ LU    

          Q 5 LUq   0   

  )&,  ¿          )   &*++,

"  /     

        ¿           "   

'H¿QLWLRQ     { 5 LUq   I +{,     

   /        

       i +{ ,   { 5 LUq q Q  { $ {  

        { ¿     L   

  )&,         {b 5 I +{,

   {+w,     L

3URSRVLWLRQ    )3,  "   4   ¿

  )E,              QY       uY      Y +{,    /                 i +{,   )E,  /        Yb +{, @ uY +{,  i +{,> { 5 LUq q +Q ^ QY , = )@, 3URSRVLWLRQ  . 1   )&,   QY ^ i3j    ¿       "    )3,

 "   4   ¿

      )@,      

{ 5 LUq q +Q ^ QY ,

  )&,     - 

         )   &*++,                 -  

              /    ¿         Y +{,        1   )&, "   

  1   )&,            )   &*++,     

 ¿          w %   

                             1  {+w,             

 P @ i{ 5 LUq = Gw Y +{+w,, @ 3j  

6  0           

     -               )   &*++,          

            

 $        J   i  

               1    Jl  J @ ^ol@4 Jl     Q ¿           Jl  6        Q     ¿     +q  4,         Vm  !      1    )&,                   

     )   &*++,

4 ^Y +{+w . k,,  Y +{+w,,` k )4,   ¿/        1       !                  /                                    )&,              ) )8    6  &**@,, Gw Y +{+w,, @ olpk$3.

      { 5 J     I3 +{,         /      

       @ Q  { $ {  

  )&,   i +{ ,   { 5 

        

6  ¿           )&,        -   

 

D            

  )&,   -           $  ¿     -        

    )&,       )   &*++,               

            

{b 5 I3 +{,=

)G,

  { 5 @ Q  I3 +{, @ ii +{,j    

 ¿ )&,       6  { 5 Q  I3 +{,         

    

    il +{, l  n  

$      /    ¿    Y +{,    . 0       

    { 5 LUq  "       

  )&, Y +{+w,,  

          g b  Y +{+w, . k{+w,, b )E, Y +{+w,, @  gk

il +{, @

olp

{ 5Jl >{ ${

i +{ , =

)H,

.         i        

  V ¿   *+{, @ 3 "             J  6 ¿      ¿  i  i +{, @ olp{ 5J > { ${ i +{ , "      I3 +{,        1      ¿        i +{,    { !                  S     V       {     1      D      i 3 +{,    

          ! i 3 9@ i             

k@3

    )   &*++, "  /       ) 0 HW DO 4555, 7KHRUHP  $    /    ¿  . 0      Y +{,    Yb +{+w,,  3 )3,

{b @ i 3 +{,=

    .             

 P      - 

     Y +{, $ 4  glvw+{> , $ 4

)+,

   {+w,   )+,   

  )&,    ¿         / 158

ht . x l +{,  xl +{,  xl +{,> +l @ 4> = = = p,> )&@, ht  ru x. l +{,  xl +{,  xl +{, >

.       {b @ i +{> x4 +{, > = = = > xu +{,, >

)*,

  { 5 LUq  i +{> x4 > = = = > xu ,       

         xl +{, l @ 4> = = = > u         

  Vl ¿   *l +{, @ 3       {          xl     Xl +{,     ¿            xl    l 9@ m       xl   xm           Xl +{,   Xm +{,   Xl +{,    

           -       yn 5 Xl +{n ,   {n $ { n @ 4> 5> = = = .  ¿     I4 +{,  I4 +{, @ i +{> X4 +{, > = = = > Xu +{,, =

            V                {b @ i3 +{,  E3 +{, ^J+{,E3 +{,`4 J+{,i3 +{,= )&G,               -   )&@,   ¿       )  ,       V E !$'"!'(($ '"%.  P  %"! 8'!2(."%$

)&5, .     p               -

"    

  )*,   

          {b 5 I4 +{,= )&&,

P +t,‚ t . F+t> t, b tb . j+t, . I +t, b @ >

.        ht {b @ i +{> xht 4 +{, > = = = > xp +{, > xp.4 +{,> = = = > xu +{,, > )&4, ht  = = = x  

 -    

    xht p 4        ¿  i  )&4,         V4  = == Vp )4  p  u,   xht l +{, 5   xl +{,> x. +{,    x +{, 

   

 xl l l         Vl  l @ 4> = = = > p "     xht l +{, l @ 4> = = = > p        -  ht u*l +{,  i +{> xht 4 > = = = > xp > xp.4 > = = = > xu , @ 3

               W vjq +t, b @ +vjq +tb4 , > = = = > vjq +tbq ,,    Iy  If       ¿   Iy @ gldj iiyl jp l@4  W b A 3   

If @ gldj iifl jp l@4  '    tb I +t, tb 9@ 3

$          

     @ 3 "   )&*,      {b @ i +{, . E+{,x+{,   { @ + t W > tbW ,W   i  E   x      ¿ "     xl @ ifl vjq+tbl ,         Vl ¿   *l +{, @ tbl @ 3 l @ 4> = = = > p "  sl @ u*l +{, @ hp.l    hm @ +3> = = = > 4> 3> = = = > 3,W     K4L      m      is4 > = = = > sp j                    V        V4 > = = = > Vp  !          /   xht 

)&E,

  x      +x4 > = = = > xp ,W  4  p  u   i3     +q  p, / E3      ¿ "       xp.4 > = = = > xu       V .      / J          sl @ u*l +{, "    JE3                 V4 > = = = > Vp     J{b @ J +i3 . E3 xht , @ 3D   J+{,i3 +{,=

)&+,

  t @ t . tg 

'       )*,      

    sl @ u*l +{,           

{ 5 V "       V4 > = = = > Vp       V )*,     

4

b I +t, b @ Iy tb . If vjq +t,

    tb tb @ b tb  j+t,  Iy t` b P 4 +t, ^  F +t> t, t‚   3 . ^If vjq +t,` b > )&*, P 4 +t,

6        i     x4 > = = = > xu      

   Vl                       

           "      I3   I4      ¿      )   &*++,

xht +{, @  ^J+{,E3 +{,`

  t 5 LUp        5 LUp     

  P @ P W A 3 F   j    

                        )$    J &*+*,        

   t @ t  tg         tg          $ )&H,     / 

  l @ 4> = = = > p  

   

                Vl ¿ )*,             ¿ )&4, )   &*++,

{b @ i3 +{, . E3 +{,x+{,>

)&H,

.        ¿    4 Y + t > t, b @ X +t,  X +tg , . tbW P +t,t> b )45, 5   X +t,          )&H,    j+t, @ CX +t,@Ct "   Yb     1             

)&3,

!           xht ¿ 159

  ¿         C       0   '          

           "   )&H, -    

CX . tbW ^F+t> t, b tb  j+t,  I +t,` b Yb + t > t, b @ tbW Ct 4 . tbW Pb +t,t= b 5   $  tbW Pb @5  F tb @ 3 )$    J b     &*+*,   Yb + t > t, b @ tbW I +t,     tb 9@ 3   Yb +3> 3, @ 3   1 ¿        Vl  6              4

    tb tb @ b P 4 ^+nj  4,j  CY4  F tb  Iy t` t‚   3 . ^If vjq +t,` b > )4E, P 4 +t,    .        4 t , . +4  nj , ^X +t,  X +tg ,` . tbW P +t,tb Y @ Y4 + 5 b    Y      1   )     j @ CX , Yb @ tbW I tb  3>            4           + t > 3, 5 LU5p    ¿               )4E,   t , -    

 xht @ +4  nj ,j+t, . CY4 + "     /          

" ¿        r      P @ q 5p b + t > t, b 5 LU = Y + t > t, b @ 3 @ + t > 3, 5 LU5p     -    

    )&3,   )&*,  ¿    xht @ j+t,=

)4&,

'   )&@,   )4&,         

           V         Vl  

   -  mjl +t,m  ifl > +l @ 4> = = = > p,

)44,

t ,m  ifl m+4  nj ,jl +t, . CY4l +

 ¿ !              @ + t > 3, 5 LU5p       1       

  

l @ 4> = = = p !       

       + t > 3, !    -    ¿      

   +3> 3, Sp t , @ l@4 nfl m tl m   ([DPSOH  $    Y4 +              nj @ 3 "      

       tl ,m A ifl     ¿   mjl +t, . nfl vjq +       j !       

  t ,  4           @ Nf vjq +          )

  ,

([DPSOH  .                  3 tb tb . ^if vjq +t,` b @ 4  vlq t  iy tb t‚  )4&44,       5     P    @ + t > t, b 5 LU = tb @ 3 @ P  m vlq+ t . tg ,m  if  !      1          @ i+3> 3,j         

   -      &           iy @ 3=8        if 



































GTGW



GTGW

T M4



E 

D  

a 

a 

T M&



 

 





W  

), MMM



 T M& 









 























 



T











),



T



W  









), MMM









T M4









W 









),



W 

 4 "     5          

  t , )

  ,      @ Nf vjq+ t , )      @ j+t,  Nf vjq+

 ,

 & 2         

              ), if @ 3=8 ), if @ 5

'      

     

'           

)nj @ 4, "   

   

        l nfl A ifl  ¿ "    ¿ 4              )   ,

t ,>  @ nj j+t,  CY4 +   nj 5 i3> 4j                        Y4   160

tb @ |> b

    S

 Y4         U W W n m t m . t  N t  . t  N t  /   Y4 @ p s L w l@4 fl l   Ns  NL A 3

b |b  I +|, b  Nf vjq+ t, |‚ @ P 4 +|,^F+|> |, b )4+, Ns t  Ng +|b  |,`> b| @ |b > |‚ @ P 4 +|,^F+|> |, b |b  F+|> |ab ,|b  KS | b . Id +|ab ,  Nff vjq+ | ,`> kG P +|,|b  I +|,

3  !$'"!'(($ $9%J9%       

             0           +tg > 3,                   N            

      !                                     

 

     

           

  Id +|ab , @ Iyd |ab .Ifd vjq+|ab , Imd @ gldj iimdl jl@4  m 5 i_y%> _f%j        Imd A Im     .          p

4 Y +{, @ tW Nf vjq+ t , . |W Nff vjq+ | , . {W E+t,{> 5 )4*,   E+t, @ gldj iNs > P +|,> KS > P +|,j  3       / !   ¿            Y     1    



 ¿

.                     | @ t 5 LUp        

   

l k   b . Ng +|b  |b ,  |b W I +t, b  Id +|ab , Yb  tbW I +t,    5 b 5 . |b , |b 5 > )E5, kG |b W P +t,|b . nt +ntn Sp   nt @ pd{t5LUp n@4 nFn +t,n5 @5         Fn    

a5 . kG |> { ab 4 @ { ab 4 ,{ ab 4  j+|,  I +{ ab 4 , { ab 5 @ P 4 +|,^F+|> { | ,`> .x . KS | . Nff vjq+ |a @ { a4 >

)43,

  kG A 3      KS A 3   / Nff @ gldj inffl jp l@4 A 3     /   | @ |  |a @ t  { a4                

Fn>lm +t, @

  l> m> n @ 4> = = = > p Plm         / P )$   kJ &*+*, l 6  

W b b b  3       | If vjq+|a,  vjq+t,

P |‚  . F+|> |, b |b . Iy |b @ KS |  kG P |b )4@, k l F+|> |ab ,|b  If vjq+|, | ,> b  vjq+|ab ,  Nff vjq+

"      )E5,     ifl A

          F+{> |,} @ F+{> },| )$    J &*+*, W

W

kG Pp nt

+Iyv . Ng ,5P > 7Iydp   A ntn b 5 . |b 5 >

  Dp+P,       ) /  ,   

 / D                                + t > |> b |> |b , @ 3         

   -           E             5         

  )4H,                    .53(                   )   , "  ¿             /         

 )

  , '        ¿           

 ¿ 3                    

   

    )Ng A 3 

  ,            )Ng @ 3    ,       

            N       

    

  0

tb @ |> b b |b  j+|,  I +|, b . x` > |‚ @ P 4 +|, ^F+|> |, b| @ |b > )4G, |‚  @ P 4 +|,^F+|> |, b |b  F+|> |ab ,|b  Iy |b KS |  kG P +|,|b  If vjq+|, b | ,`= .If vjq+|ab ,  Nff vjq+

.       

 x @ j+t,  Nf vjq+ t ,  Ns t  Ng |ab >

ifdl > 5

+Iy . Ng ,p A

. { @ + t > |b > | > |b W ,W        

 )   . , "         W

CPlm CPln CPmn .  Ctn Ctm Ctl

)4H,

  Nf @ gldj infl jp l@4 A 3     /    Nf A If    Ns @ gldj insl jp l@4  3       / .            ¿  Iy   If   /               /  Iyd   Ifd  "    

 

    

161

T M4





















 

                          

a 

a 

T M&

$FNQRZOHGJPHQW "      

       '7" 8/      E&&GG 

 





W  

), MMM



 T M&











 

T M4



W  

), MMM

G %99%9'9$





 0 O !     .  )4555,                               

  7UDQV RI WKH $60( -RXUQDO RI '\QDPLF 6\VWHPV 0HDVXUHPHQW DQG &RQWURO  G+HP G*5     )&*++, 'LIIHUHQWLDO (TXDWLRQV ZLWK 'LV FRQWLQXRXV 5LJKW+DQG 6LGHV #    2      8   '   # 6  )&**@, 4XDOLWDWLYH 7KH RU\ RI '\QDPLFDO 6\VWHPV WKH 5ROH RI 6WDELOLW\ 3UHVHUYLQJ 0DSSLQJV 8   !  ' 7   '   $ )&***, 2    0      3URF WK &RQI RQ 'HF DQG &WUO  &E5+P&E&E $ 0     2 )&**3, .        

   ,((( 7U RQ $XWR PDWLF &WUO  &*&5P&*&3 $  86   8 J )&*+*, 5RERW '\ QDPLFV DQG &RQWURO O 6  Q $  ' 7  

 





 

 

 













),





W 

),

W 

 E %     /   )

  ,         )   ,   5           t ,  Ns t  Ng |ab     

x @ j+t,  Nf vjq+ a 

a 

T M4

T M&





 





 

 

 







 T M&



W  

), MMM









 

T M4



W  

), MMM





 





 

 

 





),







W 





),



W 

 3 %    5               

 x @ j+t,  t ,  Ns t  Ng |ab        Nf vjq+   )Ng A 3 

  ,      

 )Ng @ 3    , @ '.($!'$ $      

      

                  "                 -                        "      

                           

          

   "       

       

             .  

       

      /          "            /                                "  

          

162