Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G....

77
www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves

Transcript of Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G....

Page 1: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

www.ic.unicamp.br/~lmarcos/courses/mo810

Robótica: Sistemas Sensorial e Motor

Luiz M. G. Gonçalves

Page 2: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática

Page 3: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

CinemáticaRamo da dinâmica que trata os aspectos

de movimento sem considerar massa e força.

Ligações (links): partes individuais físicas (material) que formam coletivamente o corpo de um robô

Juntas: estabelecem restrições entre as ligações (graus de liberdade).

Page 4: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Links e Juntas

Juntas podem ser: Revolutas: executam rotações em

torno de um eixo;Prismáticas: executam deslizamentos

num eixo.Cadeia cinemática: uma montagem

de ligações conectadas por juntas

Page 5: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Mecanismos abertos e fechados

Mecanismo: quando um link é fixo (sistema global) e os outros se movem relativamente ao link fixo.

Cadeia fechada: uma cadeia cinemática com todos os links conectados através de juntas a pelo menos dois links adjacentes.

Cadeia aberta: um link pode estar conectado a apenas uma junta (end-effector).

Page 6: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Graus de liberdade (DOF)

Variável de configuração: qualquer parâmetro (comprimento ou angulo) de um mecanismo (sub-restrito) que é necessário para determinar unicamente a configuração do mesmo.

Graus de liberdade: numero mínimo de variáveis de configuração necessárias para definir completamente a configuração do mecanismo.

Page 7: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Relações espaciais

Representação em relação a um frame (sistema de coordenadas)

P (X,Y,Z)

Page 8: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Descrição de posição

Page 9: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Descrição de orientação

Page 10: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Descrição de orientação

Page 11: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Descrição de orientação

Page 12: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Descrição de orientação

Page 13: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Descrição de orientação

Page 14: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Juntando posição e orientação

Page 15: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Definição de um referencial

Page 16: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Descrição de referencial

Entidade composta por 4 vetores que fornecem informação sobre a orientação e posição de um ponto num espaço tridimensional (poderia ser ndimentional, no caso, n+1 vetores seriam necessários).

Page 17: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Vários referenciais

Page 18: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Transformações e mapeamentosMapeamentos são usados para mudar a

origem de um referencial para outro.Transformação pode ser entendida como

uma função (mapeamento) que leva um objeto (ou corpo) de uma posição a outra num espaço (n-dimensional).

Podem ser lineares (obedecendo a certas regras) ou não lineares (geralmente não é possível de determinar uma regra).

Page 19: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referenciais transladados (2D)

Page 20: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referenciais transladados (3D)

AP = BP +APBorg

Page 21: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referenciais rotacionados (2D)

Page 22: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referenciais rotacionados (3D)

Page 23: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referenciais rotacionados (3D)

Page 24: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referenciais rotacionados

Page 25: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referenciais rotacionados (3D)

Page 26: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Matriz de rotação em torno de X

Page 27: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Exemplo

Page 28: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Coordenadas Homogêneas

Page 29: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referencial genérico

Page 30: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Referencial genérico

Page 31: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Juntar rotação e translação

Page 32: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Transformação Homogênea

Page 33: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Exemplo de rotação + translação

Page 34: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Exemplo: continuação

Page 35: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operadores

Mesmas formas podem ser usadas para levar um ponto de uma posição a outra no espaço considerado, ou rodar um vetor de um certo ângulo ou ainda combinar ambos

Page 36: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Translação

Page 37: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operador de translação

Page 38: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operador de translação

Page 39: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operador de translação

Page 40: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Translação pura

Page 41: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operador Rotacional

Page 42: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operador rotacional

Page 43: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Rotação em torno de cada eixo

Page 44: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operador de rotação

Page 45: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Exemplo

Page 46: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Visualizando o efeito

Page 47: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Operador de transformação

Page 48: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Exemplo R + T

Page 49: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Visualização R+T

Page 50: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Invertendo a transf. homogênea

Page 51: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Resumo

Page 52: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Resumo (cont.)

Page 53: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Transformações compostas

Page 54: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Transformações compostas

Page 55: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Transformações compostas

Page 56: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Invertendo a tranf. composta

Page 57: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Invertendo a transf.

Page 58: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Equações de transformações

Page 59: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Equações de transformações

Page 60: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Equação de transformações

Page 61: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Representação de orientações

Page 62: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Ângulos de Euler e ângulos fixos

Page 63: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Roll, Pitch, Yaw

Page 64: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Composição

Page 65: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática direta

Page 66: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática direta (CONT.)

Page 67: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Espaço de manipulação

Page 68: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática Inversa

Page 69: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática inversa (cont.)

Page 70: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática inversa (cont.)

Page 71: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática inversa (cont.)

Page 72: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática inversa (final).

Page 73: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Usando o Jacobiano

Page 74: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Jacobiano (velocidade)

Page 75: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Calculando o determinante

Dererminação das fronteiras interna e externa do círculo que define o espaço de manipulação (ângulo 2 = 0 ou PI).

Causa problemas de singularidade (velocidades infinitas em certas configurações)

Page 76: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática inversa com Jacobiano

Page 77: Www.ic.unicamp.br/~lmarcos/courses/mo810 Robótica: Sistemas Sensorial e Motor Luiz M. G. Gonçalves.

Cinemática inversa (cont.)