Escolar Documentos
Profissional Documentos
Cultura Documentos
... ...
n
Um dado vetor em um sistema n pode ser expresso no sistema
relaciona os dois sistemas:
,
indica uma matriz de rotao de um angulo
de um vetor s = (
). O produto
,
cos
sin
0
0
sin
cos
sin
0
A matriz que relaciona o sistema da base com o sistema do rgo terminal ser dada por:
A =
4 METODOLOGIA
4.1 Anlise das estruturas do rob
O rob didtico Robix (Robix Rascal, 2008)
Desenhista e Arremessador de bolas de tnis de mesa. Neste trabalho foram analisadas as estruturas do
Jogador de Golfe e do Desenhista.
Os comprimentos dos elos utilizados
paqumetro digital, os quais so: elo1: 13,05 cm; elo2: 10,65cm; Elo3: 5,75; Elo4: 5,75cm.
de golfe possui algumas limitaes mecnicas, seus
especificado na Tabela 2.
Estudo dos
conceitos de
cinemtica
direta
Anlise das
estruturas
do rob
rgo terminal em relao ao sistema de coordenadas fixo, dadas as posies de todas as articulaes
Hartemberg
denadas das juntas de um rob representa o modelo cinemtico de um sistema
articulado no espao tridimensional. A notao de Denavit Hartenberg uma ferramenta utilizada para
descrio cinemtica de sistemas mecnicos articulados com n graus de liberdade (SILVA et
Hartenberg permitem obter o conjunto de equaes que descreve a cinemtica de
com relao junta seguinte e vice-versa. So quatro os parmetros: o angulo de rotao da junta
o comprimento do elo a e o deslocamento da junta
, conhecidos como parmetros de Denavit-Hartenberg
Parmetros de Denavit-Hartenberg (CARRARA, 1999
ngulo de
rotao
Deslocamen
to da junta
Comprime
nto do elo
ngulo de
toro
Varivel da
... ... ...
pode ser expresso no sistema (n1) por meio da matriz
= Rot (z, ) Trans(0, 0,
) Trans(
, 0, 0) Rot(
de um angulo ao redor do eixo i, e Trans(
) a matriz de translao
O produto destas matrizes resulta na equao mostrada a seguir
cos t
sin
sin t
a
cos
cos t
cos
sint
a
sin
sint
0
cos t
0
d
A matriz que relaciona o sistema da base com o sistema do rgo terminal ser dada por:
A =
,
,
,
,
Anlise das estruturas do rob
(Robix Rascal, 2008) possui vrias configuraes possveis como jogador de Golfe,
Desenhista e Arremessador de bolas de tnis de mesa. Neste trabalho foram analisadas as estruturas do
Os comprimentos dos elos utilizados nos modelos matemticos foram os medidos no
elo1: 13,05 cm; elo2: 10,65cm; Elo3: 5,75; Elo4: 5,75cm.
de golfe possui algumas limitaes mecnicas, seus servos-motores possuem um limi
Anlise
cinemtica
das
estruturas
Desenvolvimento do
simulador
utilizando LabView
coordenadas fixo, dadas as posies de todas as articulaes
denadas das juntas de um rob representa o modelo cinemtico de um sistema
articulado no espao tridimensional. A notao de Denavit Hartenberg uma ferramenta utilizada para
s de liberdade (SILVA et
Hartenberg permitem obter o conjunto de equaes que descreve a cinemtica de
versa. So quatro os parmetros: o angulo de rotao da junta
e o deslocamento da junta d. Segue a tabela
Hartenberg (CARRARA, 1999;
9)
Varivel da
junta
ou
ou
...
ou
por meio da matriz transformao que
(x ,
), no qual Rot(i, )
) a matriz de translao
stas matrizes resulta na equao mostrada a seguir:
[Eq. 01]
A matriz que relaciona o sistema da base com o sistema do rgo terminal ser dada por:
[Eq. 02]
possui vrias configuraes possveis como jogador de Golfe,
Desenhista e Arremessador de bolas de tnis de mesa. Neste trabalho foram analisadas as estruturas do
foram os medidos no Robix utilizando-se um
elo1: 13,05 cm; elo2: 10,65cm; Elo3: 5,75; Elo4: 5,75cm. O Robix jogador
possuem um limite angular de giro
Comparativo
com dados
reais
Tabela 2 ngulos de rotao possveis a cada motor do Rob
Limitaes angulares
Motor Variao angular de rotao
1 135 a -45
2 0 a -180
3 90 a -90
O rob foi acionado atravs de micro-controladores e linguagem C. Foram levadas em considerao as
limitaes angulares dos motores para o acionamento do rob. Para fazer o controle das variveis angulares
do rob utilizou-se o microcontrolador AT89S8252 famlia x51o qual foi programado em linguagem C no
ambiente de desenvolvimento Keil uVisio2.
A nomenclatura definida para a estrutura do Robix Jogador de Golfe est mostrada na Figura 4a. A estrutura
possui as duas primeiras juntas rotativas revolventes (V) e a ltima rotacional (R), a Figura 4b mostra o rob
Jogador de Golfe. O rob Desenhista possui uma estrutura VRR (uma junta revolvente e duas rotacionais)
como mostra a Figura 4c:
(a) Configurao VVR (b) - Robix Jogador de Golfe (c) configurao VRR
(Rob Jogador de Golfe) (Rob Desenhista)
Figura 4 Configuraes do Rob utilizado
4.2 Anlise cinemtica
Com base no tipo de estrutura o modelo matemtico desenvolvido utilizando a notao de Denavit-
Hartemberg para cinemtica direta de manipuladores, como explicado anteriormente. Os parmetros obtidos
atravs da anlise da estrutura VVR do rob (ver Figura 5) so mostrados na Tabela 3. A obteno dos
parmetros da estrutura VRR obtida de forma anloga.
Figura 5 - Modelo esquemtico para obteno dos parmetros de Denavit-Hartemberg da estrutura VVR
Tabela 3- Parmetros de Denavit-Hartemberg para manipulador VVR
Elo
ngulo de
rotao
Comprimento
Do elo
Deslocamento
da junta
ngulo de
toro
Varivel da
junta
1
90
0 0
A partir da [Eq. 01] e dos parmetros relacionados na Tabela 3 foram obtidas as seguintes equaes:
T 0, 1=
cos
0
sin
0
sin
0
cos
0
0 1
0 0
0
0 1
[Eq. 03]
T 1,2 =
cos
sin
sin
cos
cos
sin
0 0
0 0
1
0 1
[Eq. 04]
T 2,3 =
cos
sin
sin
cos
cos
sin
0 0
0 0
1 0
0 1
[Eq. 05]
Multiplicandose [Eq. 03], [Eq. 04] e [Eq. 05] (como mostrado na [Eq. 02]), obtm-se a matriz
transformao a qual possibilita a obteno das variveis x, y e z. O simulador feito em LabView , atravs do
mtodo apresentado nesta seo, obtm as variveis cartesianas.
4.3 Desenvolvimento de simulador em ambiente LabView
O simulador foi desenvolvido em um computador Intel Celeron, sistema Microsoft Windows XP e foi
utilizado o LabView verso 8.5. Os programas feitos no LabView so chamados Instrumentos Virtuais ou VIs
(do ingls Virtual Instrument). As VIs do LabView contm duas partes principais: o painel frontal e o
digrama de blocos (National Instruments Corporation, 2005).
O painel frontal a interface de usurio, ele construdo com controles e indicadores, os quais so terminais
interativos de entradas e sadas respectivamente. O diagrama de blocos contm o cdigo fonte grfico para
controlar os objetos do painel frontal que aparecem como terminais no diagrama de blocos.
No simulador desenvolvido em LabView define-se as entradas e as sadas. As entradas indicam o dado puro a
ser processado. As entradas so os ngulos de posicionamento de cada eixo e o comprimento dos elos do
rob. As sadas representam os resultados de clculos, processamentos ou outras condies que o processo
de soluo programe. As variveis cartesianas (x, y, z) so dadas como sada. O programa fornece a posio
do rgo terminal levando em considerao as relaes existentes entre a posio das juntas e a posio
generalizada do rgo terminal (cinemtica direta). Foram desenvolvidos programas para clculo tanto do
manipulador do tipo VVR quanto do tipo VRR.
5 RESULTADOS E DISCUSSO
Foram utilizados os mesmos ngulos das juntas (valores de entrada no simulador) tanto no rob real quanto
no simulador para se saber as variveis cartesianas x, y, z (os valores de sada). Os valores e posies foram
comparados e os erros so aceitveis, o que demonstra a funcionalidade do software. Ver Tabelas 4 e 5 dos
experimentos realizados com a especificao dos valores tanto para o simulador quanto para rob real bem
como os resultados. Nas Figuras (6) e (7) so apresentadas as interfaces do software com os valores obtidos
na simulao para o manipulador VVR (Figura 6) e para o manipulador VRR (Figura 7).
Tabela 4 Experimento 1
Simulador Rob real
Variveis
de entrada
Valores
atribudos
Sada
(x, y, z)
Variveis
das juntas
Valores
atribudos
Sada
(x, y, z)
0
(11.50, -10.65, 13.04)
0
(11.48, -10.67,12)
0
Tabela 5 Experimento 2
Simulador Rob real
Variveis
de entrada
Valores
atribudos
Sada
(x, y, z)
Variveis
das juntas
Valores
atribudos
Sada
(x, y, z)
90
(10.65, 5.75, 18.79)
90
(10.51, 5.73,18. 87)
90
90
Figura - 6 Interface de usurio do simulador para clculo da cinemtica direta de um manipulador VRR
Figura 7 - Painel frontal do LabView do simulador para manipulador VRR
Apesar das pequenas variaes entre os valores reais e os simulados, o software est validado, pois, a
diferena entre os resultados dos valores deveuse a erros de medio (medies feitas com paqumetro) e
folgas nas juntas do Rob.
6 CONCLUSO
Neste trabalho, foi apresentado o mtodo de modelagem cinemtica para manipuladores utilizando-se das
noes de Denavit-Hartemberg. A partir dos parmetros para um manipulador VVR foi possvel desenvolver
um simulador em ambiente LabView, o qual foi validado pelo mtodo de comparao de valores obtidos em
um sistema real. Sistema este composto por um rob do Kit Robix com estrutura de Jogador de Golfe, um
microcontolador do tipo AT89S8252 famlia x51o qual foi programado em linguagem C no ambiente
desenvolvimento Keil uVisio2. De forma anloga foi desenvolvido tambm o simulado de cinemtica direta
para um manipulador VRR.
O desenvolvimento de um simulador didtico para anlise da cinemtica de manipuladores, alm de poder
auxiliar nas aulas prticas de disciplinas de Robtica, por exemplo, poder ser utilizado como base para
desenvolvimento de trabalhos futuros como: Projetos de controladores para compensao dos erros de
posicionamento de juntas nos robs industriais; Projeto de controladores para processo com planejamento de
trajetria.
7 AGRADECIMENTOS
Ao IFAM por ceder os equipamentos necessrios para realizao deste trabalho e pelo financiamento deste
projeto. FAPEAM pelo financiamento de passagens.
REFERNCIAS
CARRARA, V. Apostila de Robtica, 1999. Universidade de Braz Cubas. Mogi das Cruzes. Disponvel em:
<http://www.valcar.net/cursos/rb_apostila.pdf>. Acesso em novembro de 2009.
MITTAL, R.K.; NAGRATH, I.J. Robotics and Control. Tata McGraw-Hill, New Delhi, 2003.
NATIONAL INSTRUMENTS CORPORATION. LabVIEW Bsico 1: Manual do curso de
Desenvolvimento. Verso8.0. Ed. de outubro. 2005.
ROSRIO, J. M. Princpios de Mecatrnica, Prentice Hall, 2005.
ROSSATO, D.B.; Desenvolvimento de um Sistema Aberto para Ensino de Robs Manipuladores, 2009.
Dissertao (Mestrado) Departamento de Engenharia de Telecomunicaes e Controle, Escola Politcnica
da Universidade de So Paulo, So Paulo.
RUSSELL, S.; NORVIG, P. Inteligncia Artificial. 2 ed. Rio de Janeiro: Elsevier, 2004.
SANTOS, V. M. F. Robtica Industrial. Departamento de Engenharia Mecnica da Universidade de
Aveiro, 2003.
SILVA, J. C. S.; LINDER, M.; IRMO, M. A. S.; SILVA, R. P. S. Modelagem Cinemtica de um Rob
Manipulador. XXXIV COBENGE, Universidade de Passo Fundo, 2006.
SOUTO, R. S. Modelagem Cinemtica De Um Rob Quadrpede e Gerao de Seus Movimentos
Usando Filtragem Estocstica. 2007. 51f. (Graduao em Engenharia Eltrica) Faculdade de Tecnologia,
Universidade de Braslia, Braslia.
TARTARI FILHO, S. C. Modelagem e Otimizao de um rob de arquitetura paralela para aplicaes
industriais. 2006. 227f. Dissertao (Mestrado em Engenharia) - Departamento de Mecatrnica e de
Sistemas Mecnicos. Escola Politcnica da Universidade de So Paulo, So Paulo.