Escolar Documentos
Profissional Documentos
Cultura Documentos
Modelagem
Modelagem
68
5 Modelagem
69
T
=
B
onde:
A
B
R
0
A
OB
(5.1)
A
B
A
B
ai
70
di
zi-1
cos i
sin
i
i 1
Ti =
0
sin i cos i
sin i sin i
cos i cos i
cos i sin i
sin i
cos i
a i cos i
a i sin i
di
71
(5.2)
sin cos
i
i 1
i 1
Ti =
sin i sin i 1
sin i
cos i cos i 1
sin i =1
cos i sin i 1
cos i 1
sin i 1 d i
cos i 1 d i
a i 1
(5.3)
i
qi =
d i
junta rotacional
junta prismatica
A figura 5.4 mostra a tela para insero dos parmetros cinemticos do modelo
relacionado ao ligamento (link) e junta. Os campos incluem:
parmetros de DH (a, d, , );
massa;
matriz de inrcia.
72
(5.4)
73
onde:
q
q&
q&&
As equaes dinmicas podem ser obtidas de vrias maneiras diferentes, tais como: a
formulao recursiva de Newton-Euler (RNE), que se baseia na aplicao das
equaes de Newton e de Euler em cada ligamento; a formulao de Lagrange,
baseada nas energias cintica e potencial dos ligamentos; o mtodo de trabalho virtual
de D`Alembert; o mtodo de Kane (KANE, LEVINSON; 1983) para sistemas noholonmicos, capaz de produzir sistemas sem restrio e com equaes diferenciais
ordinrias de primeira ordem, a partir de sistemas com restries; entre outros.
Uma anlise comparativa, para implementao computacional de cada mtodo, j foi
realizada por alguns autores, como (CORKE, 1996) e (MATSUOKA, 2001). Por ser
mais simples, recursivo, de fcil implementao computacional e com bom
desempenho, o mtodo de Newton-Euler, na verso recursiva bastante utilizado.
A seguir temos as frmulas do mtodo Newton-Euler Recursivo (RNE) usando notao
DH padro (CORKE, 1996), tomando como referncia de parmetros a figura 5.5:
74
i +1 = i +1 R i ( ii + z 0 q& i +1 )
(5.5)
(5.6)
i +1
vi +1 = i +1i +1 i +1 p *i +1 + i +1 R i i vi
(5.7)
i +1
i +1
i +1
i +1 i +1 p * i +1 }+ i +1 R i i v&i
i +1
(5.8)
i +1 = i +1 R i i i
(5.9)
& i +1 = i +1 R i i & i
(5.10)
i +1
i +1
(
R (z
)
+ v& )+
i +1
vi +1 = i +1 R i z 0 q& i +1 + i vi + i +1i +1 i +1 p * i +1
i +1
v&i +1 = i +1
q&&i +1
(5.11)
i +1
(5.12)
75
(5.13)
Fi = mi i v&i
(5.14)
N i = I i i & i + ii (I i i i )
(5.15)
ni = i R i +1
i +1
ni +1 +
( )(R
( )(R
i n
i
Qi =
i
f i
(5.16)
T i
T i
i +1
i +1
z0
i +1
z0
} (
R i i p * i i +1f i +1 + i p * i + si i Fi + i N i
)
)
ligamento i + 1 rotacional
ligamento i + 1 prismatico
(5.17)
(5.18)
onde:
o ndice do ligamento, de 1 a n;
i
i+1
vi
i+1
vi
i+1
wi
i+1
wi
Ii
si
vCi
ni
fi
Ni
Fi
Qi
i+1
Ri
Ri 1 = i Ri 1
= i Ri 1 ;
(5.19)
p*i
76
z0
ai
p i = d i sin i
d i cos i
*
(5.20)
77
Inicializa e
aloca
variveis
Inicializa variveis
do sistema base
Clculos da recurso
para frente
(da junta 1 at n)
(j=1);
j++
Clculo da matriz de
transformao homognea
fmdh (q)
Clculo de p*
N
prismtica
junta
rotacional?
S
rotacional
Clculo da acelerao
angular (wd)
Clculo da acelerao
angular (wd)
Clculo da velocidade
angular (w)
Clculo da velocidade
angular (w)
Clculo da velocidade
linear (v)
Clculo da velocidade
linear (v)
Clculo da acelerao
linear (vd)
Clculo da acelerao
linear (vd)
Clculo da vc
(velocidade no CM)
j>n?
S
Clculos da recurso
para trs
(da junta n at 1)
(j = n);
j--
Transposio da
Matriz de Rotao
Clculo do torque do
atuador rotativo (motor)
com momento de inrcia,
atrito seco e viscoso, com
relao de reduo
j <1 ?
S
Desaloca variveis
e finaliza
78
79
5.3.1 Motor CC
O motor de corrente contnua foi bastante utilizado em manipuladores e aplicaes que
requerem controle de velocidade e posicionamento. Atualmente, em aplicaes de alto
desempenho dinmico e torque mdios e altos, vem sendo substitudo pelos motores
brushless. Na literatura amplamente estudado devido a razes histricas, pois foi
utilizado no Stanford Arm e no modelo PUMA 560.
O motor CC formado por uma parte mvel chamado rotor ou armadura e uma parte
fixa chamada estator ou campo. Um campo magntico fixo gerado no estator, por
exemplo, por um im permanente ou uma bobina. O comando realizado atravs da
variao da tenso ou corrente do rotor ou armadura.
A figura 5.7 mostra a representao em diagrama de blocos do motor CC,
L
1
RA
V
E
LA
s +1
RA
motor
iA
Km
1
Jms + B
1
s
Kb
Figura 5.7 Diagrama em Blocos do Motor CC
onde:
V a tenso de armadura; L o torque da carga; m a velocidade rotacional do
motor; m a posio do motor; RA a resistncia da bobina de armadura; LA a
indutncia da bobina de armadura; Km a constante de torque; Jm o momento de
inrcia do eixo do motor; B o atrito viscoso; Kb a constante eltrica.
80
R A L A
s + 1
K V K T R A
( s) =
V A (s)
L ( s) .
LA J m 2 RA J m
LA J m 2 RA J m
s
s +
s + 1
s
s +
s + 1
Kb Km
Kb Km
Kb Km
Kb Km
1
Kb
(5.21)
Km
RA
1
V A (s)
L ( s) .
s RA J m s + K m
RA J m s +1
( s) =
(5.22)
A figura 5.8 mostra a tela para a definio dos parmetros do modelo do motor no
sistema FEROS. Esses parmetros servem tanto para o motor CC quanto para o
servomotor.
modelo do motor;
fabricante do motor;
potncia do motor;
torque nominal;
velocidade nominal;
tenso de alimentao;
corrente nominal;
81
82
83
Na figura 5.12 temos a representao do circuito eltrico do servomotor CA, por fase.
muito semelhante ao motor CC, exceto que os valores de corrente e tenso so
senoidais.
84
85
(5.23)
(5.24)
= K T .I U .
(5.25)
A figura 5.14 mostra o diagrama de blocos, tomando a resultante das trs fases.
carga
B
VUN
IU
nM
f (VUN, nM)
KT
1 .
Jtotal s
nM
Onde: Jtotal o momento de inrcia do sistema mecnico: eixo do motor mais carga; B
o atrito viscoso; KT a constante de torque; f(VUN, nM) a funo (5.24) obtida da
equao 5.23.
86
carga
Fonte de
energia
IU*
GC(s)
VC
KA
VUN
nM
KT
f (VUN, nM)
IU
onde:
IU* a referncia de corrente;
1 .
Jtotal s
nM
87
carga
Fonte de
energia
IU*
GC(s)
VC
KA
VUN
nM
1 .
Jtotal s
KT
f (VUN, nM)
IU
nM
Figura 5.17 Diagrama em blocos do Servomotor com Drive desconsiderando a Malha de Corrente
Se esta malha de corrente for corretamente ajustada, e com tempo de resposta mais
rpido que a malha de controle de velocidade, podemos admitir que:
IU IU
*
carga
B
IU I U
*
KT
1 .
Jtotal s
nM
Na verdade, temos uma pequena constante de tempo associada, conforme figura 5.19:
88
carga
B
(IU*)PU
IUN .
TE.s+1
KT
1 .
Jtotal s
nM
onde:
IUN a corrente nominal, assim a referncia normalizada;
TE a constante de tempo devido ao atraso mdio do circuito do drive.
Devemos lembrar tambm que existem os limites mnimo e mximo para o sinal de
referncia.
A figura 5.20 mostra a tela do sistema FEROS para insero dos parmetros do drive.
modelo do drive;
fabricante do drive;
89
relevante.
90
valor da reduo;
eficincia da transmisso.
A figura 5.22 mostra a tela inicial para configurao do rob, permitindo a insero de
dados como modelo e fabricante do rob e o nmero de graus de liberdade. Alm disso
contm as informaes sobre os fatores externos citados que podem ser modificadas.
91