Escolar Documentos
Profissional Documentos
Cultura Documentos
espao de juntas
Nardnio Almeida Martins
Departamento de Informtica, Universidade Estadual de Maring, Av. Colombo, 5790, 87020-900, Maring, Paran, Brasil.
e-mail: namartin@din.uem.br
1482
Martins
(1)
= ( q , q& , q&& )
(3)
yo
Junta 6
z
H
H ( q ) = 11
H 21
G
G( q ) = 11
G21
onde:
G11 = ao 5c1 + ao6 c12 + ( po 4 c1 + po 5c12 )ao 9
G21 = ao6 c12 + ( po5c12 )ao 9
Elo 3
Elo 5
Elo 6
C 22 = 0
Junta 3
Elo 4
Junta 5
y
Junta 4
Elo 2
zo
1483
H 12
H 22
onde:
H 11 = ao1 + 2ao 2c2 + ( po1 + 2 po 2c2 )ao9
H 12 = H 21 = ao3 + ao 2c2 + ( po3 + po 2c2 )ao9
ao4 = 27.6
po5 = 4.15 .
ao7 = 0.94
ao8 = 4.54
po4 = 4.23
= ao 1 a o 2
ao 3 a o 4
ao 5
a o 6 a o7
ao 8
ao 9
]T
(1)
( q , q& , q&& ) = 11
com
11 = q&&1
C12
C
C( q , q& ) = 11
C21 C22
(2)
onde:
16 = c12
C11 = s2 ( ao 2 + po 2 ao 9 )q&2
18 = 0
Acta Scientiarum
17 = 0
1484
Martins
21 = 0
27 = q&&2
28 = q& 2
29 = p o 2 [( 1 + c 2 )q&&1 + q&&2 + s 2 q& 1 q& 1 ] + p o 5 c12
q& r = q& d q~
(1)
= 0 +
com
0 = H 0 ( q )q&&r + C0 ( q , q& )q& r + G0 ( q ) ( K v + K a q~
)r K p q~
Ka
diagonais,
positivas
( K v = K vT > 0 , K a = K a T > 0 e K p = K p T
q~
definido como:
q~
= q~i 2
(2)
(3)
i =1
Kp
simtricas,
>0 )
definidas
e o termo
(4)
Acelerao de referncia:
Acta Scientiarum
(6)
Velocidade de referncia:
(7)
Varivel de seguimento:
(8)
sendo a derivada de
igual a:
&& + q~&
r& = q&& q&&r = q~
(9)
q~ = q qd
sendo as matrizes
(5)
(10)
)r K p q~
(11)
)r + K p q~ = 0
(12)
] r + K p q~ = 0
(13)
1 T
1
r H ( q )r + q~ T K p q~
2
2
onde a matriz
Kp
definida ( K p = K pT
(14)
> 0 ).
onde
~
C ( q , q& ) = C0 ( q , q& ) C ( q , q& )
~
H ( q ) = H0 ( q ) H ( q ) ,
~
G( q ) = G0 ( q ) G( q ) .
1485
com
= 0
(18)
)r q~ T K p q~ 0
(15)
a dinmica de erro resulta em:
min { K a } q~
min { K p } q~
(16)
Acta Scientiarum
(17)
2
H( q )r& + C( q, q& )r =( q, q&, q&r , q&&r )[ + ] ( Kv + Ka q~ )r Kpq~
(19)
para
~
2
H ( q )r& + [ C( q , q& ) + K v + K a q~ ] r + K p q~ = ( q , q& , q& r , q&&r )
(20)
~
] r q~T K p q~ + r T ( q , q& , q& r , q&&r )
(21)
(22)
r >
com
~
T (.)T
~
T (.)T
4min { K p } q~
(23)
= min { K v } + min { K a } q~
~
T (.)T
~
T (.)T
2
4min { K p } q~
(24)
1486
Martins
~
1 T
1
1 ~
r H ( q )r + q~ T K p q~ + T 1
2
2
2
(25)
~
~
~&
] r q~ T K p q~ + r T (.) + 1
(26)
(27)
(28)
&
2
V& ( t ) = r T [ K v + K a q~ ] r q~ T K p q~ T 0
&
= [ (.)T r + (.)T ]
Sabe-se que V& (eq. 4.29) negativa semidefinida ( V& 0 ). Assim, conclui-se que V (eq. 4.25)
superiormente limitada j que V positiva
definida ( V > 0 ). Usando esta concluso e a
propriedade 1, segundo a qual a matriz H ( q )
simtrica, positiva definida e a sua inversa existe e
~
limitada, afirma-se que r , e so limitados. Da
definio de r (eq. 4.8), afirma-se tambm que q~ e
q~&
lim V& = 0
lim min { K a } q~
lim min { K p } q~
ou
=0
=0
=0
lim r = 0
ou
ou
lim r = 0
lim q~ = 0
(31)
lim q~ = 0
lim q~& = 0
(32)
1487
raio = 0.15 m.
centro = 0.35 m.
ao 9
desconhecido.
a o9
xd ( 3 ) = y d ( 3 ) = 0.5 m.
Acta Scientiarum
1488
Martins
e
Figura 3. Caso dos parmetros conhecidos - trajetria 01
Acta Scientiarum
1489
e
Figura 4. Caso dos parmetros desconhecidos - trajetria 01
Acta Scientiarum
1490
Martins
e
Figura 5. Caso dos parmetros adaptativos - trajetria 01
Acta Scientiarum
1491
e
Figura 6. Caso dos parmetros conhecidos - trajetria 02
Acta Scientiarum
1492
Martins
e
Figura 7. Caso dos parmetros desconhecidos - trajetria 02
Acta Scientiarum
1493
e
Figura 8. Caso dos parmetros adaptativos - trajetria 02
Acta Scientiarum
1494
Martins
CRAIG, J. J. Adaptive control of mechanical manipulators.
USA: Addison-Wesley Reading, 1988.
ERLIC, M.; LU, W.-S. A reduced-order adaptive velocity
observer for manipulator. Control. Proc. IEEE Conf. Robot.
Autom., New York, v. 2, p. 328-332, 1993.
LEWIS, F. L. et al. Control of robot manipulators. New York:
Macmillan, 1993.
ORTEGA, R.; SPONG, M. W. Adaptive motion control
of rigid robots: a tutorial. Automatica, Kidilington, v. 25, n.
6, p. 877-888, 1989.
SCIAVICCO, L.; SICILIANO, B. Modeling and control of
robot
manipulators.
Chicago:
The
McGraw-Hill
Companies, Inc., 1996.
SLOTINE, J. J.; LI, W. On the adaptive control of robot
manipulators. Int. J. Robotics Res., v. 6, n. 3, p. 147-157,
1987.
SLOTINE, J. J.; LI, W. Adaptive manipulator control: a
case study. IEEE Trans. Automatic Control, New York, v.
33, n. 11, p. 995-1003, 1988.
SLOTINE, J. J.; LI, W. Applied nonlinear control.
Englewood Cliffs: Prentice Hall International, Inc., 1991.
SPONG, M. W.; VIDYASAGAR, M. Robot dynamics and
control. New York: John Wiley & Sons, Inc, 1989.
SPONG, M. W. The control handbook. New York: CRC
Press, Inc., 1996.
TOMEI, P. Adaptive PD Controller for robot
manipulators. IEEE Trans. Robotics Autom., New York, v. 7,
n. 4, p. 565-570, 1991.
Received on August 20, 2001.
Accepted on November 22, 2001.
Acta Scientiarum