Escolar Documentos
Profissional Documentos
Cultura Documentos
Resumo
Este trabalho apresenta as principais ferramentas e resultados disponveis em modelamento de robs rgidos com o objetivo da sua utilizao em co~
trole de posio de robs. A apresentao de carter introdutorio' visando
o leitor no especialista na rea. so apresentados exemplos e resultados de
simulao para apoiar a compreenso dos conceitos. O problema de controle de
posio analisado partindo dos esquemas utilizados na prtica e passando
ao estudo de tcnicas que utilizam mais intensivamente o modelo matemtico.
Esta abordagem exemplificada atravs da tcnica do torque calculado.
1. INTRODUO
Este trabalho tem corno objetivo introduzir o leitor no especialista em ;obtica na
rea de modelagem e controle de posio de
robs. O enfoque o de analisar as ferramentas e resultados disponveis em modelagem com
o objetivo da sua utilizao no controle. Em
termos de controle estuda-se o problema de
controle de posio, discutindo-se as tcnicas utilizadas na prtica e introduzindo tcnicas baseadas na utilizao do modelo "dinimico.
As principais
ferramentas
de
modelagem
3
Vendo o controle
de posio e esforo do
rob como uma aplicao particular das tcnicas de controle de processos cabe destacar
algumas caractersticas que tm importncia
no projeto do controlador.
A. A medida direta das variveis de sada que
devem ser controladas difcil e cara.
Controlam-se de fato variveis intermedirias
DO
(1)
PRO-
acionamento
E. Gerao de trajetrias
F. Frequncias de discretizao requeridas
MODELO INVERSO/Anexo 1
Dados X, Y (coordenadas da origem do
s.c. da garra) e ~(ngulo do s.c. da
garra em relao ao s.c. de referncia)
tem-se:
MODELO CINEMTICO/Anexo 1
arctg(S2/ e2) ;
C2
S2
arctg(Y/X) -y ;
LICl + L2C12 ]
LISI + L2Sl2
I 1- C22'
(2)
- 01 - 02
[01 02
o
(4)
A relao entre torques/esforos nas juntas e na garra numa situao esttica tambm dada pelo Jacobiano: aplicando o princpio do trabalho virtual tem-se:
f(x)
Tem-se ento
v=
J (0) n
VT
[v x v y
nT
[e l O.2
onde:
FT
(3)
V z Wx
wy
= [fx.f y f~ nx ~y n z]
vetor de esforos e
torques na garra
onde
o
V =, J(0) n
A obteno do modelo cinemtico tipicamente um processo adequado para ser automatizado atravs de tcnicas de projeto assistido
por computador e clculo simblico [Ferreira,
1988].
]3" ,:
Wz ]
esforos
ou
en ]
[01 02 0n]
rotacioDado que
=J
tem-se finalmente:
JACOBIANO/Anexo 1
'f3 - Ou 81 + 32 82 + 33 83
'f2 - 02l
8+
22 82 + 23 83 + 0211
f + 02
1112L~
IIIZL~
023 - 0.1
0211 1112Ll L2S2
02
- 1112L2 8 12
f +0122~ +
2
(D1l2 +D121)l2 + 01
011
012
- 0.1 +
013
- 0.1
1112L~
0111 -m3 Li L2 S2
0122 - -(1112 + 1113)L1L2S2
(7)
i=l N
(6)
onde:
: esforo/torque na junta i
: nmero de juntas
varivel da junta j (posio ou ngulo)
parmetros de inrcia
i = j inrcia efetiva da junta i
i =/= j inrcia de acoplamento entre
as juntas i e j
M(0) (;)
+ V(0,E +
(;(0)
(8)
onde:
(i" j
=/=
k)
MODELO DINMICO
Supondo
para
os
dois
primeiros ele7
(contendo
os
1 0 - - - - - - - - r - - - - ---,
S
(9)
ol------+:~-~.,-=.~-------l
onde Mx , Vx e Gx so obtidas
M, V, G e do Jacobiano.
partir
de
-+
-1.0 l..-;.....J
-0.9
--;'!';--'
o.
Fig. 1
.........
..-"
92.
'. ..
'
~'..
e.,
?o-
O ....
'
..
-'
..
~t
--.
-..
............
- 9 0 - " ......
....
, ..
..... ...........
93
.
.".-
.. - ...
4txJl-------+..-'-----..J'---t
2.
seg
Fig. 2
40 ..
("_
,I
,,:
-r;o- .- ""tI.
.. ...... . .. 4-,
: ......
,
,,
1-
....... - ,
__ ~ ....
-....
.40~
~
't
~~
..-;.1...~.
I
Fig. 3
8
,-'
2.
-..
relao de reduo
Ks
constante de mola
TR,
obtm-se:
0m(s)
(KI/R) Num(s)
V(s)
Den*(s)
ames)
T(s)
Den*(s)
aR,(s)
ames)
Num(s)
(12)
onde:
Num(s)
Fig. 4
ameS)
V(s)
kI/R
Den{s)
ameS)
;~
, T(s)
---~
Den(s)
onde:
KI
constante de torque
resistncia
(10)
JR,
Ks
BR,
s2 + - s + 1
Ks
4. CONTROLE DE POSIO
A maioria dos robs industriais existentes no mercado utilizam controladores para ca
da junta baseados no controle em cascata da
posio e velocidade. Frequentemente o contro
le de velocidade e de corrente ~ feito em for
ma analgica e uma malha de controle digital
externa ~ responsvel pelo controle de posio. Considerando uma junta isolada, o esquema de blocos correspondente, utilizando as
eqs. 10, ~ o indicado na figura 5 [Luh, 1983a].
Fig. 5
onde:
r~ pode
10
J m + n 2 J R,
Bm +
n 2 BR,
- atrito seco;
- efeito de toro
que;
na transmisso
do tor-
T =
M(0)a + V(0,
+ G(0) + F(0,
(13)
= M(0)
+ G(0) + F(0,
M(0)
.a
+ V(0,
+
(14)
+ G(0) + F(e,
..
11
. + KpE =
+ KVE
(15)
Fig. 6
(16)
Dado que em geral a matriz M(0) nao dia
gonal, as equaes serio acopladas, isto e, o
comportamento de cada junta influir nas
outras.
T =
Vj
mji fji(0,
0)
i=l
=o
M- l [(M-Ml0+
(18)
Uj
L
KVE + KpE
E+
M(0)0 + Q(0,
I
i=l
qji gji(0,
)
(19)
(17)
.A figura 6 pod ser utilizada para visualizar outr's. tp.j.a$ de controle com menor ou
maior utiliz9 gq m9delo dinmico. O contro
le de posiC~q- vel.,c-etdade descrito iniciai:
mente correspQ~d
~o M-I, V = G = F = O.
E~ fraig~ 1986a] so propostas duas tcnicas
:f.:~~_~_rmediariaE!:' l'ff~ti.ve j ointinertia" com
Utiliza-se
12
lei
de controle do torque
lizados na prtica. Estas tcnicas de controle certamente estaro baseadas numa maior uti
lizao dos modelos matemticos que descrevem
o comportamento do rob e do seu sistema de
acionamento. O objetivo ser o de eliminar
comportamentos no satisfatrios como oscilaes devidas a no-linearidades e polos pouco
amortecidos e conseguir caractersticas na res
posta suficientemente independentes da confi=
gurao ou do meio externo.
+ Q(0, E))
(20)
(21)
Nesta equao $ o vetor de erros nos parme
tros e a matriz W contm funes conhecidas~
A lei de adaptao tipo gradiente proposta
dada por
onde
4>
o vetor
de parmetros estimados:
REFER~NCIAS
da positiva.
7.
BIBLIOGRFICAS
Asada, H., Lim, S.K., (1987). The Joint Torque Feedback Control of a Direct-Drive
Arm. Preprints X IFAC World Congress,
vol. 4, pp. 238-243, IFAC.
Craig, J. J. ,. (1986a). Introduction to Robotics: Mechanics and Controlo AddisonWesley, Reading, Mass.
O problema real de controle t"requentemente o controle conjunto de posio e esforo na garra. Esta , por exemplo, a situao
em tarefas de montagem. Os trabalhos sobre con
trole de esforo so bem menos frequentes n
literatura ainda que as primeiras implementaes datem de 1940/1950 [Whitney, 1985]. Como
colocado nesta referncia o problema mais
vasto que o controle de posio dado que exige a integrao de: i) planejamento da tarefa
em termos de definio dos graus ;de liberdade
da garra que sero controlados em posio ou
esforo [Mason, 1981], ii) gerao da trajetria, iii) realimentao e controle da posio e do esforo e iv) modificao da trajetria em funo das medidas. Em [Whitney,
1985] so apresentados diferentes esquemas de
controle e discute-se o problema de estabilidade que surge quando se tentam obter respostas rpidas no controle do esforo aplicado
pela garra sobre elementos rgidos. A incluso da possibilidade de movimentos de acomoda
o na garra , para este autor, a nica sol~
o compatvel com resposta rpida e esforos
de contato pequenos entre a garra e o ambiente.
6. CONCLUSES
A utilizao de robs em tarefas complexas como montagem, e o aumento da velcidade,
implicar na utilizao de mecanismos de controle mais complexos do que os atualmente uti13
ANEXO 1.
! '
"
00"
rta:iol1ai'~l'
.,
aT
Rot(Z, 01)
2T
3
'-SI
Cl
~]
lT
2
[ClSI
r=
,:
[C2S2
'-S2
[C3S3
-S3
C2
C3
n
~2]
(AI)
14
- - -
------------------------------------------'
sen(8i)
8 i +l
cos(8i)
i+l Zi + l
cos(8i + 8j)
o modelo
cinemtico: ~T
dado por:
i+l
i+liF(iVi + i wi x i p i+l.
)
(A6)
(A2)
Modelo Inverso
Da equao A2, com X, Y e ~
figura A.l, obtm-se:
indicados na
C~
C123
8~
8123
LlC l +
L1 8l + L25 l2
(A3)
L 2C12
82
C2
x2 + y2 -
Li -
L~
, 2L l L2
8 2 ..
I 1- C2'
2
(A4)
arctg(Y/X) _ y; y
Jacobiano
Considerando dois elementos i e i+l separados por uma junta rotacional i+l tem-se os
seguintes resultados:
i+l w
i+l
(AS)
onde:
i+l
wi+l
i+~R
1
( i+liR)-l
= i+
iRT.
de~ota
l ' i+liR. matriz
_
_
0VT
ao corres:e0!l
dente a i+tr.
15
rov 3x 0v3y 0
11I
3z