Documente Academic
Documente Profesional
Documente Cultură
CURITIBA
2012
CURITIBA
2012
Este trabalho de concluso de curso foi apresentado no dia 09 de julho de 2012, como
requisito parcial para obteno do ttulo de Tecnlogo em Mecatrnica Industrial, outorgado
pela Universidade Tecnolgica Federal do Paran. O(s) aluno(s) foi(ram) argudos(s) pela
Banca Examinadora composta pelos professores abaixo assinados. Aps deliberao, a Banca
Examinadora considerou o trabalho aprovado.
___________________________
Prof. Milton Luiz Polli
Coordenador de Curso
Departamento Acadmico de Mecnica
______________________________
Prof. Dcio Estevo do Nascimento
Responsvel pela Atividade de Trabalho de Concluso de Curso
Departamento Acadmico de Eletrnica
BANCA EXAMINADORA
__________________________________
Prof. Dr. Luiz Carlos de Abreu Rodrigues
____________________________
Prof. M. Sc. Juliano Mouro Vieira
Orientador
_________________________________
Prof. Dr. Rubens Alexandre de Faria
A Folha de Aprovao assinada encontra-se na Coordenao do Curso
RESUMO
MALAQUIAS, Fernanda D.; ASSOLARI, Karina; NOGAWA, Marcos L. Desenvolvimento
de um sistema de controle de um brao robtico de cinco eixos. 2012. 80 f. Trabalho de
Concluso de Curso (Curso de Tecnologia em Mecatrnica Industrial) Departamentos
Acadmicos de Eletrnica (DAELN) e Mecnica (DAMEC), Universidade Tecnolgica
Federal do Paran. Curitiba, 2012.
Este projeto prope o desenvolvimento de uma luva para controlar um brao robtico didtico
encontrado no Laboratrio de Automao e Sistemas Inteligentes da Manufatura da
Universidade Tecnolgica Federal do Paran, no campus Curitiba, e de uma nova interface de
comunicao entre um computador e este rob, com o objetivo de tornar seu controle mais
simples. A nova interface de comunicao foi desenvolvida no ambiente de programao
Labview, adicionando novas funes para atender as necessidades dos usurios deste
laboratrio, tais como a possibilidade de salvar e carregar programas contendo sequncia de
comandos a serem enviados para o rob e a possibilidade de editar linhas especficas dos
programas. Os componentes principais da luva so dois acelermetros e um microcontrolador
PIC. Para o desenvolvimento desta, foi necessrio programar o microcontrolador em
linguagem C e aplicar conhecimentos de cinemtica inversa. Para facilitar a movimentao do
rob com a luva foi necessrio incluir um pequeno teclado (denominado teclado luva), que
define quais juntas sero movimentadas e qual a sensibilidade do movimento. Foi criado
tambm um novo controle (denominado teclado controle) que em conjunto com a luva e o
teclado luva substituem o controle teaching Box original do brao robtico. O teclado
controle tem a funo de salvar posies e executar programas pr-definidos no rob. Para
validao dos prottipos desenvolvidos foram realizados testes prticos destes, comunicandoos com o brao robtico. O rob foi movimentado com a luva auxiliada pelo teclado luva, o
teclado controle executou as funes programadas corretamente e a nova interface de
comunicao entre o computador e o rob tambm cumpriu os objetivos desejados. Os
resultados obtidos foram considerados satisfatrios pelos membros da equipe, pois atenderam
o objetivo geral do trabalho.
Palavras-chave: Sistemas hpticos. Controle de brao robtico. Interfaces de comunicao.
ABSTRACT
MALAQUIAS, Fernanda D.; ASSOLARI, Karina; NOGAWA, Marcos L. Development of a
control system for a five axes robotic arm. 2012. 80 f. Trabalho de Concluso de Curso
(Tecnologia em Mecatrnica Industrial) Departamentos Acadmicos de Eletrnica
(DAELN) e Mecnica (DAMEC), Universidade Tecnolgica Federal do Paran. Curitiba,
2012.
This project describes the development of a glove to control a didactic robotic arm located at
the Laboratory of Automation and Inteligent Systems for Manufacturing at Universidade
Tecnolgica Federal do Paran, campus Curitiba, and a new communication interface
between a computer and this robot, in order to make its controlling simpler. The new
communication interface was developed using Labview, adding new functions to meet the
needs of the users of this laboratory, such as the possibility of saving and loading programs
with sequences of commands that will be transmitted to the robot and the possibility of editing
specific lines of a program. The main components of the glove are two accelerometers and a
PIC microcontroller. For its development it was necessary to program the microcontroller in
C language and use knowledge of inverse kinematic. To make the robot movement easier
using the glove it was necessary to include a small keyboard (named glove keyboard), that
defines which joints will be moved and define the movement sensibility. A new controller
was created (named controller keyboard) that, together with the glove and the glove keyboard,
replaces the original teaching box of the robotic arm. The controller keyboards purpose is to
save positions and run pre-defined programs stored in the robot. To validate the developed
prototypes, practical tests were executed, communicating them with the robotic arm. The
robot was moved using the glove, aided by the glove keyboard; the controller keyboard
executed the programmed functions properly; and the new communication interface between
the computer and the robot also met the desired objectives. The results obtained were
considered satisfactory by the members of the team, because they met the general objective.
Keywords: Haptic systems. Robotic arm control. Communication interface.
LISTA DE FIGURAS
Figura 1 Diagrama de blocos da situao atual do laboratrio .........................................................13
Figura 2 Diagrama de blocos da sugesto de melhoria para o laboratrio ........................................14
Figura 3 Exemplos de sistemas hpticos .........................................................................................17
Figura 4 Esquemtico de juntas e elos em braos robticos.............................................................19
Figura 5 Tipos de juntas e movimentao das juntas .......................................................................20
Figura 6 Exemplo de robs com junta deslizante e rotativa .............................................................20
Figura 7 Exemplificao de como se identificar grau de liberdade em juntas deslizantes .................21
Figura 8 Graus de liberdade do rob Mitsubishi RV-M1.................................................................22
Figura 9 Associao do brao robtico com o brao humano ..........................................................22
Figura 10 Teaching box ..................................................................................................................23
Figura 11 Caixa indicativa..............................................................................................................24
Figura 12 Distncias fsicas do rob ...............................................................................................25
Figura 13 Relao deslocamento/sinal de sada do acelermetro .....................................................26
Figura 14 Vistas inferior e superior do acelermetro de modelo MMA7455L .................................27
Figura 15 Funcionalidade geral dos microcontroladores .................................................................28
Figura 16 Classificao dos microcontroladores PIC ......................................................................29
Figura 17 Exemplo de transmisso de dados pela porta serial .........................................................31
Figura 18 Como ocorre o envio e recebimentos de dados na comunicao serial .............................32
Figura 19 Pinagem do conector RS-232..........................................................................................32
Figura 20 Leitura no protocolo SPI.................................................................................................34
Figura 21 Escrita no protocolo SPI .................................................................................................34
Figura 22 Diagrama de blocos da utilizao do MAX 232 ..............................................................35
Figura 23 Diagrama em blocos do projeto ......................................................................................36
Figura 24 Exemplo de tela do Labview...........................................................................................37
Figura 25 Tela do programa do Labview finalizado ........................................................................38
Figura 26 Diagrama dos temas abordados no tpico de eletrnica ...................................................39
Figura 27 Circuito bsico do microcontrolador PIC ........................................................................40
Figura 28 Foto do gravador de PIC EDUTECHKITS .....................................................................40
Figura 29 Exemplo de tela do software Winpic ...............................................................................41
Figura 30 Exemplo de tela do software CCS...................................................................................41
Figura 31 Gravador PICSTART Plus..............................................................................................42
Figura 32 Exemplo de tela do software Mplab ................................................................................42
Figura 33 Circuito utilizando o CD4053 .........................................................................................43
Figura 34 Funes atribudas aos microcontroladores .....................................................................44
Figura 35 Circuitos eletrnicos que compem a luva ......................................................................45
Figura 36 Fotos do circuito acelermetro mo finalizado ................................................................45
Figura 37 Fotos do circuito luva finalizado .....................................................................................45
Figura 38 Circuito divisor de tenso ...............................................................................................46
Figura 39 Circuito amplificador de tenso ......................................................................................46
Figura 40 Circuito integrao PIC e acelermetro ...........................................................................47
Figura 41 Foto da fonte ..................................................................................................................48
Figura 42 Fotos da placa fonte finalizada ........................................................................................48
Figura 43 Foto do teclado luva finalizado .......................................................................................49
Figura 44 Fotos do circuito do teclado luva finalizado ....................................................................50
Figura 45 Fotos do teclado controle finalizado................................................................................51
Figura 46 Fotos do circuito teclado controle finalizado ...................................................................51
Figura 47 Dados do acelermetro na aquisio com variao angular .............................................53
Figura 48 Grfico da equao da aquisio de dados angulares .......................................................54
Figura 49 Dados do acelermetro no movimento retilneo ..............................................................55
Figura 50 Movimentao do acelermetro com ngulo de 45 sobre o eixo Y .................................55
Figura 51 Dados do acelermetro (em ngulo de 45 sobre o eixo Y) na aquisio do movimento
retilneo ............................................................................................................................................56
LISTA DE TABELAS
Tabela 1 Tabela de polaridades e fases no protocolo SPI ................................................................33
Tabela 2 Tabela de funes do teclado luva ....................................................................................49
Tabela 3 Tabela de funes do teclado controle ..............................................................................51
Tabela 4 Tabela comparando vantagens e desvantagens do mtodo Move Position (MP) ................61
Tabela 5 Tabela comparando vantagens e desvantagens do mtodo Move Joint (MJ) ......................61
LISTA DE SIGLAS
AGV
ATX
CI
CLP
CPU
CS
DAELN
DAQBI
DCE
DTE
EEPROM
IC
IHM
LabVIEW
LASIM
LCD
LED
PIC
RAM
ROM
RS-232
SCLK
SDI
SDO
SI
SO
SPI
USART
USB
UTFPR
SUMRIO
1
INTRODUO ................................................................................................................10
1.1
PROBLEMA .........................................................................................................................12
1.2
OBJETIVOS .........................................................................................................................14
1.2.1
Objetivo geral ....................................................................................................................14
1.2.2
Objetivos especficos..........................................................................................................14
1.3
JUSTIFICATIVA ...................................................................................................................15
2
FUNDAMENTAO TERICA ...................................................................................17
2.1
SISTEMAS HPTICOS ..........................................................................................................17
2.2
ROBS INDUSTRIAIS MANIPULADORES ...............................................................................18
2.3
ROB MITSUBISHI RV-M1 .................................................................................................21
2.4
CINEMTICA INVERSA DO ROB MITSUBISHI RV-M1.........................................................24
2.5
ACELERMETRO ................................................................................................................26
2.6
ACELERMETRO MMA7455L ............................................................................................26
2.7
MICROCONTROLADOR ........................................................................................................28
2.8
MICROCONTROLADOR PIC16F876A...................................................................................29
2.9
COMUNICAO SERIAL RS-232..........................................................................................30
2.10
COMUNICAO SERIAL SPI (SERIAL PERIPHERAL INTERFACE) .............................................33
2.11
CIRCUITO INTEGRADO MAX 232........................................................................................34
3
DESENVOLVIMENTO...................................................................................................36
3.1
LABVIEW ...........................................................................................................................36
3.2
ELETRNICA ......................................................................................................................38
3.2.1
Microcontroladores ............................................................................................................39
3.2.2
Luva ..................................................................................................................................44
3.2.2.1 Circuitos eletrnicos que compem a luva ..........................................................................44
3.2.2.2 Integrao entre microcontrolador e acelermetro ...............................................................46
3.2.3
Mdulo Fonte.....................................................................................................................48
3.2.3.1 Teclados.............................................................................................................................49
3.3
CONFECO DE PLACAS DE CIRCUITO IMPRESSO.................................................................52
3.4
ACELERMETRO ................................................................................................................52
3.5
ESTRUTURA MECNICA .....................................................................................................58
3.6
PROGRAMAO ..................................................................................................................60
3.6.1
Programao da luva ..........................................................................................................61
3.6.2
Programao do teclado controle ........................................................................................64
4
CONSIDERAES FINAIS ...........................................................................................66
REFERNCIAS ..............................................................................................................................67
APNDICE A COMANDOS DO ROB RV-M1 .......................................................................70
APNDICE B TABELA DE PINAGEM E DIREO DE FLUXO DE DADOS NA
COMUNICAO RS-232 ..............................................................................................................73
APNDICE C PROGRAMAO DO LABVIEW ....................................................................74
APNDICE D CIRCUITO ESQUEMTICO DA PLACA ACELERMETRO MO ...........75
APNDICE E CIRCUITO ESQUEMTICO DA PLACA LUVA ............................................76
APNDICE F CIRCUITO ESQUEMTICO DA PLACA FONTE ..........................................77
APNDICE G PINAGEM DOS CONECTORES ......................................................................78
APNDICE H CIRCUITO ESQUEMTICO DA PLACA TECLADO LUVA........................79
APNDICE I CIRCUITO ESQUEMTICO DA PLACA TECLADO CONTROLE ..............80
APNDICE J CONFIGURAES DO ACELERMETRO MMA7455L PARA
UTILIZAO COM O MICROCONTROLADOR PIC18F252 ..................................................81
APNDICE K FLUXOGRAMA DE PROGRAMAO DA LUVA ........................................82
APNDICE L FLUXOGRAMA DE PROGRAMAO DO TECLADO CONTROLE..........84
10
INTRODUO
a. Custo: o investimento inicial alto, mas menor que o custo total para empregar
funcionrios (levando em conta que o rob pode trabalhar cerca de 98% da
atividade considerada);
b. Melhora a produtividade: geralmente robs trabalham mais rpido que
humanos e reduzem o desperdcio de materiais;
c. Melhoria da qualidade do produto: velocidades e preciso de posicionamento
melhores do que o do trabalho humano;
d. Capacidade de operar em ambientes hostis ou com materiais perigosos; e
e. Melhora no gerenciamento da produo: a utilizao de robs facilita o
processo de aquisio de dados j que estes podem ser adquiridos
instantaneamente, via computador e processados com agilidade.
11
12
1.1
Problema
13
14
Luva
Computador
Brao
Robtico
Joystick
Mdulo
Independente
Figura 2 Diagrama de blocos da sugesto de melhoria para o laboratrio
Fonte: Autoria prpria.
1.2
Objetivos
Implementar uma haptic glove para controle de um brao robtico e nova opo de
interface de comunicao entre computador e brao robtico.
15
1.3
Justificativa
16
17
FUNDAMENTAO TERICA
2.1
Sistemas Hpticos
Um sistema hptico aquele que interage com o usurio de maneira fsica (fora,
vibraes e/ou movimento). composto de hardware e software que transmitem informaes
tteis que permitem ao usurio interagir com objetos a longa distncia ou na realidade virtual
atravs de um retorno sensorial. De acordo com Gomes [20--?], esse retorno sensorial pode
ser de dois tipos: ttil (sensvel ao toque) e cinestsico (sensvel a movimentos). O retorno
ttil proporciona ao usurio sentir temperatura e rugosidade. No ser humano a percepo
dessas propriedades ocorre, principalmente, na regio dos dedos e mos. O retorno cinestsico
utiliza-se de foras para representar movimentos e basicamente copia a funo de ossos e
msculos (GOMES, [20--?]). Estas foras podem ser acelerao, peso e compresso, por
exemplo.
A evoluo desses sistemas caminha juntamente com a evoluo da automao. De
acordo com Gomes ([20--?]), os primeiros sistemas operados a longa distncia foram
construdos em 1950, no laboratrio de Argonne (Estados Unidos da Amrica), pelo Dr.
Raymond C. Goertz, para segurar remotamente substncias radioativas. Atualmente essa
tecnologia est presente em vrias reas: celulares, jogos, medicina e indstrias. Na figura 3
h vrios exemplos de sistemas hpticos.
Ao longo dos anos so desenvolvidas, cada vez mais, interfaces das quais o usurio
pode se aproximar dos recursos computacionais de modo intuitivo utilizando aplicaes como
18
2.2
De acordo com Silva et al. (2006), o tipo de rob mais utilizado o manipulador que
tem sua utilizao direcionada execuo de tarefas com certo grau de risco onde
caractersticas como preciso, eficincia e repetibilidade so caractersticas imprescindveis.
Os braos robticos so exemplo dos robs classificados como manipuladores.
Rosrio (2005, p. 148), descreve que para a execuo das tarefas requeridas pelo usurio, o
brao robtico move partes, objetos, ferramentas e dispositivos especiais segundo
movimentos e pontos pr-programados.
Os braos robticos so basicamente compostos de juntas e elos (tambm chamados
de vnculos) que podem ser observados na figura 4 (Carrara, [19--?]). Lopes (2002)
complementa que uma das extremidades do rob fica fixa a uma base e a outra extremidade
oposta d suporte a um rgo terminal que pode movimentar-se livremente no espao. Esta
extremidade livre pode ser, por exemplo, uma garra ou uma ferramenta.
19
De acordo com Rosrio (2005), existem trs tipos de juntas encontradas nos
manipuladores industriais:
a. Deslizantes: permite o movimento linear entre dois vnculos (elos). Estas juntas
so compostas de dois elos alinhados um dentro do outro, sendo que o elo
interno escorrega pelo externo desenvolvendo um movimento linear;
b. Rotativas: a conexo existente permite a rotao entre dois elos unidos por uma
dobradia comum dando a liberdade de uma poder se mover em movimento
cadenciado em relao outra; e
c. Bola-e-encaixe: este tipo de conexo se comporta como se fosse a unio de trs
juntas de rotao, o que permite movimentao em torno dos trs eixos.
20
21
Tipicamente um brao robtico possui seis graus de liberdade: trs deles destinados
ao posicionamento da ferramenta terminal e os outros trs para orientao. Este nmero de
graus de liberdade utilizado quando o rob necessita alcanar todos os pontos do ambiente
de trabalho e, no caso especifico dos braos robticos, o nmero de juntas geralmente igual
ao nmero de graus de liberdade (ROSRIO, 2005).
2.3
O rob RV-M1 um brao robtico com cinco graus de liberdade (eixos rotacionais)
produzido pela empresa Mitsubishi. Os eixos podem ser denominados cintura, ombro,
cotovelo, ngulo de afastamento e ngulo de rolamento, como mostrados na figura 8.
22
Cada um dos cinco eixos deste brao robtico pode ser associado a um determinado
movimento do corpo humano, conforme indicado na figura 9:
23
realizada de maneira simples atravs de posies escolhidas pelo usurio (por um controle
manual, pelo computador ou at mesmo um controlador lgico programvel CLP).
A programao do rob pode ser feita de duas formas: por um controle (teaching
box), como pode ser visualizado na figura 10, ou pelo computador atravs da porta de
comunicao serial RS-232 (Recommended Standard-232) (MITSUBISHI, [19--?]).
24
2.4
25
Laus (2006) destaca que a cinemtica inversa, alm de produzir as equaes das
variveis de junta, usada para se obter um algoritmo que permita calcular de forma
computacional as variveis de junta respeitando os limites fsicos do rob.
Para se determinar o algoritmo desejado necessrio considerar a cinemtica direta,
a multiplicidade de solues e a influncia que uma junta causa nas outras (LAUS, 2006).
Foram estudadas as seguintes equaes, elaboradas por Laus (2006), para serem
utilizadas especificamente com o rob Mitsubishi RV-M1:
(1)
(2)
2 arctan 2(( pz d 1 d 6 * sin 234) * (a 2 a3 * cos 3) ( px / sin 1 d 6 * cos 234) * (a3 * sin 3),
( px / sin 1 d 6 * cos 234) * (a 2 a3 * cos 3) ( pz d 1 d 6 * sin 234) * (a3 * sin 3))
4 234 2 3
(3)
(4)
26
2.5
Acelermetro
2.6
Acelermetro MMA7455L
27
Este dispositivo pode ser utilizado, por exemplo, em telefones celulares, deteco de
queda-livre, anti-roubo em computadores portteis, jogos e detectores de posio.
A imagem a seguir (figura 14) a foto do acelermetro, nas vistas inferior e superior,
respectivamente.
28
2.7
Microcontrolador
29
2.8
Microcontrolador PIC16F876A
30
2.9
De acordo com Soares (2008), a porta de comunicao serial (RS-232) est presente
na comunicao de vrios tipos de mquinas e seus perifricos e este tipo de comunicao
permanecer nas reas de automao industrial pelas prximas dcadas.
A RS-232 permite comunicao bidirecional entre dois componentes, onde o dado
transmitindo em forma de um byte, bit por bit ou em uma sequncia pr-determinada pelo
programador e chega ao receptor que interpreta e processa os dados recebidos (NICOLOSI,
2002).
Para que a comunicao na forma serial seja padronizada, nas diversas aplicaes
que so possveis, foram estipuladas algumas normas, citadas a seguir (SOARES, 2008):
a. Existem apenas dois nveis lgicos possveis: 0 lgico e 1 lgico (sem
nveis intermedirios);
b. As tenses so sempre em corrente contnua;
c. A tenso correspondente ao nvel lgico 0 deve estar compreendida entre
-3V e -15V;
31
32
Na figura 19 est o desenho das duas portas RS-232 existentes. Elas apresentam
diferentes tamanhos (mais pinos ou menos pinos) que funcionam da mesma forma podendo
ser escolhidas de acordo com a aplicao desejada.
33
a comunicao
feia
diretamente
(SIEMEINTCOSKI;
WACKERHAGEN, 2008).
De acordo com Pereira (2003, p. 268), um protocolo de simples implementao j
que no existe facilidade de software para convivncia de mltiplos dispositivos
simultaneamente no mesmo barramento e composto fisicamente por quatro linhas de
sinais:
a. Seleo de dispositivo (CS chip select): utilizada para selecionar qual
dispositivo que deseja se estabelecer comunicao. o elemento fsico que
prev a utilizao de mltiplos dispositivos no sistema;
b. Clock (SCLK): utilizada para estabelecer sincronizao entre os dispositivos
mestres e escravos. O dispositivo que gera o sinal de clock o mestre e o que
recebe o escravo;
c. Entrada Serial (SI serial in): recepo de dados; e
d. Sada Serial (SO serial out): sada de dados.
Existem quatro modos de operao; cada modo apresenta polaridade (CPOL) e fase
(CPHA) de clock distintas, conforme a tabela 1 (PEREIRA, 2003):
Tabela 1 Tabela de polaridades e fases no protocolo SPI
MODO
CPOL
0
0
1
0
2
1
3
1
Fonte: Autoria prpria.
CPHA
0
1
0
1
DESCRIO
O dado armazenado na borda de subida do clock
O dado armazenado na borda de descida do clock
O dado armazenado na borda de descida do clock
O dado armazenado na borda de subida do clock
Pereira (2003) ressalta que todas as operaes executadas que utilizam esse protocolo
so precedidas de oito bits (que descrevem a natureza da operao) e observa que
importante verificar em cada dispositivo utilizado as especificaes do fabricante para este
tipo de comunicao, j que no h um padro muito rgido e universal.
34
35
facilita o projeto dos circuitos j que no h necessidade de criar um circuito secundrio com
fonte de alimentao de 12 V para converter o sinal mandado pelo microcontrolador de 5V
(TEXAS INSTRUMENTS, 2002).
Na figura 22 est um diagrama de blocos que representa o papel desempenhado pelo
MAX 232 em um circuito utilizando comunicao serial e microcontrolador.
RS 232
Nvel lgico
RS 232
(12V)
MAX
232
Nvel lgico
TTL (5V)
Microcontrolador
36
DESENVOLVIMENTO
3.1
Labview
37
38
janela de leitura do ltimo comando enviado ao rob; (F) boto de envio de comando ou
programa ao rob; (G) janela de leitura da serial do rob; (H) quantidade de bits recebidos
pela serial; (I) boto de parada do programa. Para iniciar o programa, necessrio abrir o
arquivo executvel Labview_ROBOT.exe. A tela de programao do Labview encontra-se no
apndice C.
3.2
Eletrnica
39
3.2.1 Microcontroladores
40
pelo fabricante (figura 27), para em seguida fazer programas simples de teste, transferir para o
PIC e visualizar os resultados.
A princpio foi utilizado um gravador de PIC pertencente equipe (figura 28). Nessa
situao trabalha-se com os softwares Winpic (figura 29) e CCS (figura 30). O software
Winpic utilizado para transferir o programa, desenvolvido e compilado no software CCS,
para o microcontrolador atravs da porta serial.
41
42
no existe porta serial; assim foi testado o gravador com um conversor USB (Universal Serial
Bus)/serial. Infelizmente a corrente mnima necessria para o funcionamento do gravador no
fornecida pelo conversor.
Como alternativa foi utilizado o gravador PICSTART Plus (figura 31) emprestado
pelo DAELN que funciona corretamente com o conversor.
Com este gravador so utilizados os seguintes softwares: Mplab (figura 32) e CCS
(explicado anteriormente). O software Mplab exerce a funo de transferir para o
microcontrolador o cdigo elaborado no CCS.
43
O segundo teste realizado teve como objetivo montar um circuito que permitisse a
comunicao simultnea entre o microcontrolador e computador ou microcontrolador e rob
(atravs da porta serial RS-232). Para isto foi utilizado o componente CD4053 para
multiplexar/demultiplexar os sinais de entrada e sada do PIC para duas portas seriais RS-232.
Na primeira tentativa de utilizao do CD4053, seguindo somente o datasheet
(FAIRCHILD SEMICONDUCTOR CORPORATION, 2000), o sinal no passava sempre
pelo componente. Seguindo um circuito (figura 33) apresentado por Keen (2000), a diviso do
sinal do PIC para as duas portas seriais foi bem sucedida.
44
microcontroladores fica na placa fonte (seo 3.2.3) e o outro est localizado na placa luva
(seo 3.2.2.1). A descrio das funes atribudas a cada microcontrolador pode ser
observada na figura 34.
45
Placa luva
Placa acelermetro mo
Figura 35 Circuitos eletrnicos que compem a luva
Fonte: Autoria prpria.
46
47
At ento haviam sido feitos testes com apenas um acelermetro. O prximo passo foi
integrar o segundo acelermetro. So interligados entre os acelermetros os sinais de CLOCK
e PIC (SDO). Foi adicionado na programao do microcontrolador um modo de selecionar
com qual acelermetro ser estabelecida a comunicao (pino CS), pois utilizado apenas um
acelermetro por vez.
Nos testes em protoboard foi detectado um sinal de rudo na entrada do PIC. A
soluo encontrada foi colocar um capacitor para filtrar este sinal. Na placa de circuito
impresso verifica-se que no h este rudo, tornando-se desnecessrio utilizar este capacitor de
filtro. O rudo provavelmente foi causado pelo protoboard.
recomendado que o acelermetro fique o mais prximo possvel do controlador
(FREESCALE SEMICONDUCTOR, 2007) porque a corrente do pino ACEL (SDO) muito
pequena. Caso o acelermetro encontre-se distante do controlador, ocorre falha na
comunicao entre eles. Como pode ser observado na seo 3.2.2.1, o acelermetro localizado
na placa acelermetro mo est h uma distancia maior do microcontrolador do que o
48
segundo acelermetro localizado na placa luva. Este problema foi solucionado com o uso do
amplificador operacional TL082.
Placa fonte
Fonte de alimentao
49
3.2.3.1 Teclados
Funo
Pausa a luva
Alterna a junta a ser controlada
Envia o rob para a origem
Muda estado da garra (abrir)
Muda estado da garra (fechar)
Ajusta a sensibilidade de movimentao do rob
Para o sistema
50
51
Funo
Posio de descanso do rob
Roda o programa que est armazenado no rob
Salva a posio
Limpa a posio
Move para a posio selecionada
Determina a numerao da linha em que ser salva a posio
Cancela a ltima operao
Envia o comando digitado
Liga e desliga o teclado (localizado na parte superior)
Para o sistema (boto vermelho localizado na parte inferior)
Alm dos botes de emergncia localizados nos teclados, existe ainda um terceiro
localizado na caixa do mdulo fonte. Eles esto interligados e ligados diretamente na porta
52
3.3
3.4
Acelermetro
53
Labview, mas a comunicao falhou. Foi feita ento a comunicao entre PIC e hiperterminal
e a comunicao ocorreu normalmente, levando concluso que o problema estava na
configurao do Labview. Feitas as devidas configuraes, a comunicao foi estabelecida
conforme esperado.
Inicialmente, com o acelermetro em um local plano e em repouso, obtivemos um
valor fixo em cada eixo indicando a posio de referncia. Os resultados obtidos foram
coerentes com as explicaes das sees 2.5 e 2.6.
Foram feitos trs testes para estudar mais a fundo o acelermetro: aquisio de dados
com variao angular, movimento retilneo e movimento retilneo com o acelermetro em
ngulo de aproximadamente 45 em relao ao plano do cho.
A aquisio de dados com variao angular do acelermetro foi feita com o auxlio
de um transferidor. Com esse instrumento foi possvel encontrar uma relao entre ngulos e a
resposta do acelermetro. A figura 47 indica a variao dos dados do eixo Y do acelermetro
adquiridos num perodo de 4,3 segundos em uma movimentao de 0 a 90 com retorno a 0
em relao ao plano do cho.
Esses valores foram inseridos numa planilha do software Microsoft Excel com o qual
foi produzida uma equao de segundo grau (figura 48) que estima a resposta do acelermetro
de acordo com a variao do ngulo em relao ao plano cho. Essa equao tornou possvel
54
55
Movimentao
ro
et
m
er
el
Ac
45
Eixo Y
Com isso foi possvel obter dados do movimento retilneo com acelermetro em
ngulo de 45. Na figura 51 encontram-se os resultados obtidos.
56
Figura 51 Dados do acelermetro (em ngulo de 45 sobre o eixo Y) na aquisio do movimento retilneo
Fonte: Autoria prpria.
Ei
xo
ta
n
e
vim
ro
et
m
er
el
Ac
45
Eixo Y
57
Os dados obtidos com esse tipo de movimento podem ser observados na figura 53.
58
3.5
Estrutura Mecnica
59
60
3.6
Programao
61
Desvantagens
Mapear o plano cartesiano
Implementao complexa na programao
Tratamento de sinal do acelermetro complexo
Programa ocupa mais memria do PIC
Desvantagens
Menos intuitivo para o usurio
Limites fsicos do rob difceis de definir
Pereira (2003) apresenta em seu livro uma biblioteca de comunicao SPI para o
PIC. Esta biblioteca foi escolhida por conter um cdigo genrico que pode ser utilizado com
qualquer PIC e simples de ser entendida e utilizada. Para esta deciso foram estudadas a
biblioteca encontrada no software CCS e a fornecida por Pereira (2003).
O programa interpreta os sinais dos acelermetros e de acordo com outros
parmetros definidos no teclado luva envia comandos para a movimentao do rob. Existem
as seguintes condies de funcionamento: o boto pausa do teclado luva e o boto
ON/OFF do teclado fonte devem estar na posio 0.
O programa configura as interrupes internas e externas do microcontrolador,
habilita a comunicao com rob e configura os acelermetros. Essas configuraes foram
feitas
de
acordo
com
datasheet
fornecido
pelo
fabricante
(FREESCALE
62
zerar o valor de referncia dos eixos X, Y e Z respectivamente. Deste modo pode-se trabalhar
diferenciando os dados do acelermetro em positivo e negativo, de acordo com a direo do
movimento.
De acordo com a leitura dos eixos x e y do acelermetro da mo e do eixo x do
acelermetro do pulso, possvel uma diferenciao dos movimentos feitos pelo usurio. Na
figura 57 demonstrado o movimento de giro do pulso do usurio; essa ao modifica o valor
do eixo y do acelermetro da mo. Com esse dado feita a movimentao da base (ngulo de
movimento 1 ) ou do giro do punho do brao robtico (ngulo de movimento 5 ), regido
pelo estado do boto punho/cotovelo localizado no teclado luva.
Base
Punho
63
Base
64
Punho
Base
O PIC que realiza a varredura do teclado matricial est localizado na placa fonte.
65
66
CONSIDERAES FINAIS
Com este projeto foi possvel adquirir novos conhecimentos sobre acelermetros
(funcionamento e aplicao), sistemas hpticos, confeco de placas de circuito impresso,
programao de microcontroladores PIC e programao em ambiente Labview. Foi possvel
tambm aprimorar alguns conhecimentos vistos durante o curso, como eletrnica bsica,
comunicao serial, cinemtica, usinagem e hardware e software do rob Mitsubishi RV-M1.
O objetivo geral deste projeto foi alcanado, pois resolveu os problemas citados no
incio deste trabalho. A nova interface para programao do rob facilita a sua programao, a
luva melhora a dinmica para controlar o brao robtico e atualmente possvel rodar um
programa, que esteja salvo na memria do rob, sem a necessidade do uso de um computador.
Quando feita uma proposta de projeto nem sempre possvel determinar o melhor
mtodo para o desenvolvimento deste, levando em conta conhecimentos ainda a adquirir e a
complexidade de execuo. Devido a isso, a proposta inicial deste projeto foi alterada em dois
pontos: o controle do rob pela luva atravs do computador foi abandonado; e a comunicao
simultnea do microcontrolador da luva com ambos computador e o rob se tornou
desnecessria. A primeira modificao do projeto se deu pela complexidade de aprendizagem
em programar em ambiente Labview. Infelizmente os conhecimentos adquiridos sobre este
ambiente no foram suficientes para programar o controle da luva. A segunda adaptao est
ligada primeira, pois como o computador no foi utilizado para o controle da luva no houve
necessidade de implementao da comunicao entre eles.
So sugeridas as seguintes melhorias para este projeto:
67
REFERNCIAS
68
MICROCHIP. Scaling the PIC MCU & dsPIC DSC families. Disponvel em:
<http://www.microchip.com/stellent/idcplg?IdcService=SS_GET_PAGE&nodeId=2551>.
Acesso em: 31 set. 2011.
MICROCHIP TECHNOLOGY. PIC16F87XA data sheet. Chandler: Microchip Technology,
2003. 234p.
MITSUBISHI. Industrial micro-robot system RV-M1. Nagoya: Mitsubishi. [19--]. 260p.
NICOLOSI, Denys Emlio Campion. Microcontrolador 8051 detalhado. 3. ed. So Paulo:
rica, 2002.
NIKU, Saeed B.. Introduction to robotics analysis, systems, applications. Upper Saddle
River, NJ.: Prentice-Hall, 2001. 349 p.
PAZOS, Fernando. Automao de sistemas & robtica. Rio de Janeiro: Axcel, 2002. 377 p.
PEREIRA, Fbio. Microcontroladores PIC linguagem C. So Paulo: rica, 2003. 358 p.
PEREIRA, Filipe. Circuitos de Interface para Microcontroladores. Revista Saber Eletrnica,
So
Paulo,
mar.
2011.
Disponvel
em:
<http://www.sabereletronica.com.br/secoes/leitura/1714>. Acesso em: 21 jun. 2011.
ROBOTICS Exchange. Mitsubishi RV-M1. Disponvel em: <www.roboex.com/s19>.
Acesso em: 10 ago. 2010.
ROBTICA industrial: aplicao na indstria de manufatura e de processos. So Paulo:
Edgard Blcher, 2002. 256p.
RODRIGUES, Carlos E. Um dispositivo hptico de auxlio navegao para deficientes.
Disponvel em: <http://www.cin.ufpe.br/~tg/2005-2/cemr.pdf> Acesso em: 2 set. 2010.
ROSRIO, Joo Maurcio. Princpios de mecatrnica. So Paulo: Prentice-Hall, 2005.
356p.
SANDOR, B. I. Engineering mechanics: design. Englewood Cliffs, N.J.: Prentice-Hall,
1983. 499p.
SIEMEINTCOSKI, Michael; WACKERHAGEN, Guilherme. Comunicao Serial: Protocolo
SPI e perifrico USART para microcontroladores- Parte 2. Revista saber eletrnica, So
Paulo, jan. 2008. Disponvel em: <http://www.sabereletronica.com.br/secoes/leitura/279>.
Acesso em: 21 jun. 2011.
SILVEIRA, Paulo Rogrio da; SANTOS, Winderson Eugenio dos. Automao e controle
discreto. 4. ed. So Paulo: rica, 2002 229 p.
SILVA, Joo C. S.; LINDER, Marcelo; IRMO, Marcos A. da S.; SILVA, Ricardo P. da.
Modelagem cinemtica de um rob manipulador. CONGRESSO BRASILEIRO DE
ENSINO
DE
ENGENHARIA.
2006.
Passo
Fundo.
Disponvel
em:
<http://www.dee.ufma.br/~fsouza/anais/arquivos/1_66_333.pdf>. Acesso em: 21 jun. 2011.
69
70
Comando
Descrio
DP (Decrement
Position)
DW (Draw)
HE (Here)
HO (Home)
IP (Increment
Position)
MA
(Move Approach)
MC
(Move Continuous)
MJ (Move Joint)
MO (Move)
MP (Move Position)
MS
(Move Straight)
MT (Move Tool)
NT (Nest)
OG (Origin)
PL (Position Load)
Formato
DP
DW <DistnciaX>,
<DistnciaY>, <DistnciaZ>
HE <Nmero da Posio>
HO
IP
71
PX (Position
Exchange)
SF (Shift)
SP (Speed)
TI (Timer)
TL (Tool)
DL (Delete Line)
GC (Grip Close)
GO (Grip Open)
ED (End)
GT (Go To)
ER (Error Read)
LR (Line Read)
PR (Position Read)
WH (Where)
EQ (If Equal)
RC (Repeat Cycle)
NX (Next)
RC <Nmero de repeties>
NX
72
RN (Run)
RS (Reset)
(Coment)
Observaes:
73
Sigla
CTS
DCD
DSR
DTR
RI
RTS
RxD
GND
TxD
Significado
Clear To Send
Data Carrier Detected
Data Set Ready
Data Terminal Ready
Ring Indicator
Ready To Send
Received Data
Signal Ground
Transmitted Data
Traduo
Pronto para enviar dados
Portadora detectada
Conjunto de dados pronto
Terminal de dados pronto
Indicador de toque/campainha
Pronto para enviar (computador)
Recepo de dados
Sinal de terra
Transmisso de dados
Fluxo de Dados
DCE para DTE
DCE para DTE
DCE para DTE
DTE para DCE
DTE para DCE
DCE para DTE
DTE para DTE
74
75
76
77
78
DB9
DB15
DB37
79
80
81
Registro
$16
$0D
Nome
MCTL
I2CAD
$10
$12
$14
XOFFL
YOFFL
ZOFFL
Definio
Modo de controle (sensibilidade e modo medio)
Endereo do protocolo de comunicao I2C
(Usado para desabilitar a I2C)
Offset do eixo X (bit menos significativo)
Offset do eixo Y (bit menos significativo)
Offset do eixo Z (bit menos significativo)
82
83
84
85