UNIVERSIDADE DE AVEIRO 2006/07 Departamento de Electrónica, Telecomunicações e Informática Departamento de Engenharia Mecânica Projecto Humanóide da Universidade de Aveiro Autoria: Daniel José Figueiredo Baptista N.º Mec. 21824 - LEET Pedro Miguel Sá Figueiredo Ferreira N.º Mec. 27593 - LEET [email protected] .ua.pt [email protected] Orientação: Filipe M.T. Silva DETI-IEETA ([email protected]) Vítor M. F. Santos DEM-TEMA ([email protected]) 1. Introdução ENQUADRAMENTO A concepção de um Robot Humanóide constitui um dos maiores desafios na área da robótica: Um projecto de colaboração entre o DETI e o DEM, iniciado em 2003, permitiu a construção de uma plataforma humanóide de baixo custo para a realização de investigação em áreas tão diversas como o controlo, a percepção e a navegação Pequenos, compactos e relativamente baratos Incluem motor, redutor e electrónica de controlo Continuação do estudo dos sensores de pressão Estudo dos sensores de inclinação Não disponibilizam controlo de velocidade e/ou binário Comportamento não linear em função da carga Estudar e implementar algoritmos de movimentos de alto-nível Criar uma interface visual user-friendly Selecção da Unidade Central de Processamento a adoptar Instalação de Embedded LINUX Integração do sistema de visão e de capacidades de processamento Arquitectura distribuída Rede de controladores interligados por CAN-bus Configuração Master/Multi-Slave Erro - diferença entre a inclinação desejada e a medida K Amplitude fixa - ganho do controlador DDR RAM de 256 Mb 200 pin Correias de transmissão para elevar binários Posição do motor (variável) Aplicação Modelo Massa (g) Binário (Nm) ~20 0.35 119 2.26 8. Padrões de Locomoção 5. Sensores de Pressão Main Control RS232 Master Controlador baseado na matriz jacobiana Controlo do CoP e da altura da anca CAN BUS Slaves 3 1 2 2 3 2 2 1 1 1 Master e Slaves: CAN bus a 1 Mbit/s Master e PC: série RS232 a 115 Kbaud 3 3 2 2 1 1 3 3 2 2 1 1 Equação de controlo: Δq = K·JT·e Δq: incremento de velocidade K: ganho JT: transposta da matriz jacobiana para o CoP e: erro entre o CoP desejado e o medido CoM x tilt foot CoM y J tilt foot CoM z tilt foot CoM x roll foot CoM y roll foot CoM z roll foot CoM x knee CoM y knee CoM z knee Velocidade de actuação reduzida Centro de Pressão pode ser aproximado pela projecção do Centro de Gravidade no solo Planeamento de trajectórias Foot 4 CoM Fsensor rsensor sensor 1 4 F y sensor Espaço das juntas Espaço cartesiano Unidades de Controlo Slave: Movimentos definidos Locomoção Pontapé Rotação Sensor 4 Foot base Acelerómetro ADXL202E da Analog Devices O ADXL202E é um acelerómetro de dois eixos (Pitch e Roll) Giroscópios GYROSTAR ENJ03JA from MURATA A escala de medida do ADXL202E é de ±2 g O acelerómetro ADXL202E, permite a medição de acelerações dinâmicas (acelerações instantâneas) e acelerações estáticas ( aceleração da gravidade) Extensómetros colados a placas deformáveis Tornar a interacção com o robô humanóide userfriendly Integração, numa única aplicação, de múltiplo trabalho desenvolvido Integração de movimentos de alto-nível Corrente consumida pelo servomotor Sensores dos pés Motivações Planeamento de trajectórias no espaço das juntas ADXL202E from ANALOG DEVICE INCLINAÇÃO DO TRONCO Sensores de força mostram uma resposta aceitável Boa resposta no controlo de equilíbrio Zonas de singularidade a evitar O controlador de inclinação do tronco cumpre com os requisitos O algoritmo de locomoção necessita de pequenos ajustes para uma aplicação prática Inicio do movimento pouco funcional O sistema de visão iniciou a sua caminhada Tracking de uma bola com resultados satisfatórios Unidade Central de Processamento Disponibiliza condições de desenvolvimento Visualização da trajectória Pitch ASIN ( Ax / 1g ) Roll ASIN ( Ay / 1g ) TILT 12. Conclusões 9. Simulador TwoLegs_22dof Funcionalidade Acelerómetros para medir a inclinação do tronco Pan & Tilt Três graus de liberdade Controlo em três juntas Processamento de imagem (OpenCv) Filtro por cor Detecção de Círculos Cálculo do centro de massa Template Match PAN Rotação 6. Acelerómetros / Inclinómetros 3. Capacidades Sensoriais Resolução: 640 x 480, 320 x 240, 160 x 120 Formato: YUV (4:1:1, 4:2:2, 4:4:4), RGB-24bit Frame rate: 30, 15, 7.5, 3.75 fps Saida: FireWire400 Mbps Tracking de uma bola em movimento Pontapé Sensor 3 Flexible beam Locomoção Strain Gauge Comandam até 3 actuadores Permitem controlo local Interface via piggy-back (HITEC Motor) Câmara digital Unibrain Fire-i x Adjustable screw 11. Sistema de Visão Câmara Movimentos quasi-estáticos sensor 1 Potenciómetros para medir a posição Resposta do controlador 20 ms Comunicações assíncronas: Unidade de visão (Câmara CCD) Solid State Disk IDE de 44 pin Controlo satisfatório da inclinação do tronco Sinal de Saída 2. Arquitectura do Sistema 22 graus de liberdade Peso: 6 kg Altura: 60 cm 2.5 - relação de transmissão entre o servo e a junta. Resultados Braços & juntas de baixo HS85BB binário Pernas & juntas de alto binário HS805BB Plataforma humanóide PC/104 Dual PCMCIA Module Delta - incremento a aplicar ao servomotor Actuação e Leitura Sensorial PWM de controlo de posição (entrada) Impulso de “corrente” (variável) PC/104 AMD LX800 CPU Board Delta 2.5 erro k Limitações/desvantagens Controlo de posição: PWM a 50 Hz e duty-cycle de 1-2 ms Leitura da posição e estimativa da corrente consumida OBJECTIVOS 10. Unidade Central de Processamento Função de controlo proporcional Sensor 2 Construir um ser artificial semelhante ao homem é um sonho inato Marcas como a Sony ou a Honda já deram os primeiros passos Situado na anca, permitindo o controlo da inclinação do tronco Actuação nas juntas: servomotores HITEC Sensor 1 7. Sensores de Inclinação 4. Actuadores Gestão de elementos visuais Bola Escadas Gestor de Movimentos Perspectivas de futuro Introdução dos giroscópios Integração no simulador de modelo dos sensores Desenvolvimento de uma plataforma de controlo em Linux