65
Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores de Electrotecnia e Electrónica DEAR DEAR Robot Robot

Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Embed Size (px)

Citation preview

Page 1: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Atelier de FormaçãoIniciação à robótica móvel

Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo

Associação Nacional de Professores de Electrotecnia e Electrónica

DEAR DEAR RobotRobot

Page 2: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Caderno de encargos

Robô móvel autónomo, capaz de:

Seguir uma pistaSubir e descer uma rampaDetectar coresDetectar obstáculosAvisar por meio de som/luzVideo da arena

Page 3: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Opções técnicas

Face à complexidade do tratamento das informações recolhidas nos sensores, decidiu-se pelo controlo por microcontrolador.

Face ao tipo de piso e à necessidade de rapidez, optou-se por uma tracção diferencial, com duas rodas motrizes e uma roda de apoio livre.

Page 4: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Opções técnicas

Tecnologia

Keep

It

Seriously

Simple

Page 5: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Estrutura Mecânica (chassis)

1. Construção da Plataforma

Factores a ter em conta:– Simplicidade

• Minimizar o número de partes móveis e a complexidade do robô

– Robustez• resistência aos impactos

Page 6: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Estrutura Mecânica

Modularidade– O robô deve ser composto por um grupo

de módulos que se interliguem de tal forma, que um dos módulos possa ser substituído sem necessidade de remoção dos restantes

– Materiais aconselhados para a plataforma: Vidro acrílico, PVC ou contraplacado

Page 7: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Estrutura Mecânica

Forma (plataforma simples):Roda livre

Vista de baixo

motores

Vista Lateral

Page 8: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Estrutura Mecânica

Forma (plataforma dupla): Roda livre

Vista de baixo

motores

Vista Lateral

Page 9: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Estrutura Mecânica (Sugestão)Sensor de obstáculos

Placa controlador

roll-on

servos

Sensor de pista

bateria

Page 10: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Geometria do problema

Localização dos sensores de pista Geometria da rampa

A rampa, com 25º de inclinação, coloca problemas

– quanto à localização do centro de gravidade, – quanto ao binário disponível para a superar e – quanto à geometria e localização dos sensores.

Page 11: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Geometria do problema

Here we go!!!!!!!!!!!!!!

Page 12: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Geometria do problema

O centro de gravidade do carro deverá estar centrado e o mais baixo possível, de modo a que em plena rampa, não caia fora dos pontos de apoio das rodas

Page 13: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Geometria do problema

Quanto à localização dos sensores de pista, importa reparar que no início da subida estes se afastam do solo, podendo deixar de “sentir” a pista, como se vê na figura.

Page 14: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Geometria do problema

Pelo contrário, no fim da subida, os sensores aproximam-se perigosamente do solo, podendo ficar presos.

Page 15: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Geometria do problema

Assim, e tendo em conta a geometria do problema, sugere-se a localização dos sensores próximo dos eixos das rodas.

Page 16: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Problema da Estabilidade DinâmicaOs sensores de pista devem estar o mais afastados possível das rodas motrizes.

Page 17: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Problema da Estabilidade DinâmicaNeste caso, a correcção da trajectória implica um ângulo de rotação maior, logo, a maior oscilação do robô.

Page 18: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores

Existem 3 tipos possíveis de motores

– CC (corrente contínua) - mais potentes, controlo difícil, caros, exigem mais electrónica

– Passo-a-Passo - pouco potentes, pesados, controlo muito fácil

– Servos - muito potentes, leves, controlo fácil e baratos – foi a opção tomada

Page 19: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC

Como controlar o motor CC– A inversão de marcha exige uma ponte H

como a da figura

M

+

-

En

Dir

Frente

Trás

Page 20: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC

Podemos construir uma ponte com componentes discretos - os transistores funcionam, como interruptores.

M

-

+Controlo Avanço

Controlo Recuo

Page 21: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC

Podemos utilizar um circuito integrado como o L293D que contem duas pontes, já protegidas com díodos para correntes até 600 mA.

Page 22: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC O circuito integrado

L293D vai ter duas alimentações. Uma para comando (5V) e outra para potência (9.6 V).

A Tabela permite programar o movimento em qualquer direcção (conjugando 2 motores)

Page 23: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC Controlo de velocidade Utiliza-se um sinal PWM (Pulse Width

Modulation)

A velocidade do motor varia proporcionalmente à área debaixo da porção positiva de cada período

T T T

média

Page 24: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC Ajuste da velocidade e do binário O motor, por si só, não se encontra

preparado para ser usado directamente num robô– Problema - velocidade excessiva (>5000

rpm) e binário disponível insuficiente.– Solução - Uso de sistemas de

engrenagens que reduzam a velocidade de rotação e aumentem o binário disponível.

Page 25: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC

Vantagens– Torna possível a utilização de

microcontroladores– Reduz as perdas térmicas nos

componentes, pois nem sempre a tensão é aplicada

Page 26: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Motores CC Relação binário/velocidade

Nº dentes roda 1

1 T2

2 T1

Nº dentes roda 2Nº dentes roda 1

Nº dentes roda 2Relação transmissão =

Page 27: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

RODAS

O diâmetro das rodas irá condicionar a velocidade do robô.

Rodas maiores Velocidade linear maior Num minuto, uma roda desloca-se:

s = 2 . . R . n R - raio da roda

n - nº de rotações p/minuto

Page 28: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Servo Motores

Os servomotores são motores particularmente concebidos para o modelismo.

Potentes, de baixo consumo, leves, resistentes ao choque e baratos.

Page 29: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Servo Motores

Page 30: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Servo Motores No seu uso normal

os servos rodam ângulos que dependem da largura do impulso fornecido

Para o uso em robôs móveis, é necessário adaptá-los para rotação contínua.

Page 31: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Agora que já sabe como funciona um servomotor, vamos descrever como pode transformr um servomotor R/C num excelente motor de corrente contínua com redutor de velocidade.

O que se vai fazer é modificar o servo de modo a que este funcione sem batente e sem electrónica de controlo.

Page 32: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Os passos seguintes ajudá-lo-ão a realizar as modificações.

Retire o parafuso que prende a flange ao eixo do servo.

Page 33: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Abra a caixa removendo os 4 parafusos localizados na base do servo.

A tampa da base deve ser retirada lentamente e com cuidado. Remova a tampa do topo da caixa.

Page 34: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Tenha cuidado em anotar o modo como estão dispostas as rodas dentadas e remova-as do topo do servo.

Coloque-as sobre uma folha de papel pela mesma ordem com que estavam no servo. A roda dentada fina ao centro não precisa ser retirada.

Page 35: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Seguidamente, é preciso remover da caixa a placa do circuito electrónico.

Para isso, vai ser necessário dessoldar os terminais do motor que estão directamente inseridos na placa.

Page 36: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Page 37: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Localize e remova o pequeno parafuso philips do potenciómetro na figura e retire o conjunto placa de circuito impresso+cabo+potenciómetro.

Page 38: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Dessolde o cabo (ou corte-o) e use os condutores encarnado e preto para ligação directa aos terminais do motor.

Deixe o condutor de sinal (branco ou amarelo) sem ligação.

Page 39: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Remova o batente da roda dentada como se indica na figura (use x-acto ou alicate).

Page 40: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Modificar um Servomotor

Volte a colocar as rodas dentadas nos seus lugares, começando pela do meio. Quando todas estiverem colocadas, coloque as duas tampas. Finalmente aperte os quatro parafusos da caixa. Os servos estão finalmente em condições de serem utilizados no seu robô.

Teste o servo, com uma tensão CC de 6V.

Page 41: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores

Tipos de problemas a resolver:

detecção de obstáculos a curta distância

seguimento de pista detecção de cores seguimento de paredes detecção de inclinação

Page 42: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de obstáculos

Por toque (contacto) com interruptores mecânicos ou whiskers.

Page 43: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de obstáculos Por IV a distância.

Não alterar!!

Page 44: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de obstáculos

Page 45: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de obstáculos

Page 46: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de pista

Sensor de pista Este dispositivo possui

três sensores infra-vermelhos que permitem detectar por reflexão, o contraste preto-branco da linha preta face ao fundo branco.

Page 47: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de pista

É constituído por três pares emissor/receptor idênticos constando cada um de um led emissor na banda dos infra-vermelhos e de um fototransistor sensível na mesma banda.

Como a cor preta absorve as radiações e a cor branca as reflecte, temos assim o nosso fototransistor (sensor) a conduzir ou não.

Os três leds são activados sequencialmente através de um microcontrolador, efectuando-se as leituras dos fototransistores nesses instantes.

Page 48: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de pista

Page 49: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de cores

O detector de cores é constituído por um divisor potenciométrico: uma resistência ajustável e uma LDR (o sensor).

Page 50: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores- detecção de cores

Seria sempre preferível ligar sequencialmente as cores RGB (3 leds) e efectuar medições separadas, mas isso não constitui um valor acrescentado para uma decisão rápida sobre a cor).

Page 51: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Sensores-detecção de Inclinação

Page 52: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Avisadores

Sonoro – bezouro

Luminoso - LED

Page 53: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Microcontrolador

Picaxe 28X Características:

600 linhas código

21 pinos E/S

9-17 saídas

0-12 entradas

0-4 entradas A/D

2 saídas PWM

Page 54: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Linguagens de programação

PBasic (compatível com Basic Stamp)

Ambiente integrado de desenvolvimento com suporte para programação gráfica por fluxogramas.

Editor, compilador, programador e debugger incorporados.

Page 55: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Contactos

ANPEEhttp://www.anpee.org

Picaxehttp://www.picaxe.co.uk

Ludgero Leotee-mail: [email protected]: leote2000

Page 56: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Robocup/Robótica2006

Robocup Portuguese Committeehttp://robocup.isr.ist.utl.pt/

Robótica 2006

http://www.robotica2006.dei.uminho.pt/robotica2006/

Page 57: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

http://satchmo.cs.columbia.edu/rcj/

Page 58: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Etapas de trabalho - desenhar

Page 59: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Etapas de trabalho - desenhar

Page 60: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Etapas de trabalho - desenhar

O desenho do chassis em papel facilita o corte do PVC e a dobragem

Page 61: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Etapas de trabalho – cortar e furar

Operações de corte, dobragem, furação

Page 62: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Placa do controlador - Stripboard

O Stripboard é uma placa que possui pistas paralelas de cobre num dos lados. As pistas estão separadas de 0.1" (2.54mm) e nelas existem furos espaçados de 0.1" (2.54mm).

Circuito em Stripboard (pistas do lado do cobre).

Page 63: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Placa do controlador - Stripboard

Os Stripboard são utilizados para realizar circuitos permanentes utilizando soldadura. São ideais para fabricar pequenos circuitos com um ou dois circuitos integrados (chips).

Cortes e reparações no stripboard. Testes das ligações

Page 64: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Pontos de teste

1

1

2

21

2

+9V

-+

1 1 1

Page 65: Atelier de Formação Iniciação à robótica móvel Princípios de Construção Mecânica e Electrónica de um MicroRobô Móvel Autónomo Associação Nacional de Professores

Esquema de ligações

M2 M1

9V

9,6V

Alimentação dos sensores

Ligação ao cabo série paraprogramar

Sensor de pista (3inputs)

Sensor de obstáculos(2outputs)

Sensor de obstáculos(1input)

Sensor de cor

BezouroLed