© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
1. Introdução
2. Programação de tarefas de robôs
3. Proposta de algoritmo numérico para a geração de trajetórias
4. Discretização do caminho 5. Interpolação e filtragem de
pontos de passagem no espaço das juntas
CAPÍTULO 11
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
1. Introdução
• A geração de trajetórias é realizada a partir do modelo geométrico do robô e representa a evolução no tempo da posição, da velocidade e da aceleração das juntas do robô.• As trajetórias podem ser especificadas em coordenadas de juntas ou cartesianas.• A programação de tarefas de robôs pode ser realizada por meio do espaço das juntas ou do espaço de tarefas.• A obtenção de referências correspondentes às tarefas definidas no espaço operacional é denominada coordenação de movimentos.• Para solucionar o problema da inversão do modelo geométrico, usa-se o método analítico ou o método numérico.• Para implementar um algoritmo de geração de trajetórias no espaço cartesiano, é necessário conhecer o modelo geométrico do robô e também os métodos para sua inversão.
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória de um robô para movimentação da posição A até a posição B
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Robô executando uma tarefa que necessita de um movimento em linha reta
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
2. Programação de tarefas de robôs
• A programação de tarefas de robôs é realizada no espaço das juntas.• A trajetória angular, de mesma natureza dos sinais provenientes do transdutor
de posição, serve de referência para o controlador de cada junta robótica, após interpolação.• Na maioria das aplicações, a realização de tarefas está relacionada com o tipo de ferramenta utilizada, orientada a partir de um sistema de coordenadas cartesianas fixo à base do robô.• Os movimentos desejados e as leis de controle estão em espaços diferentes.
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Malha de controle de um robô
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
3. Proposta de algoritmo numérico para a geração de trajetórias
• Para implementar um algoritmo de geração de trajetórias, é preciso inverter o modelo geométrico.• O algoritmo deve calcular a matriz jacobiana do sistema a cada iteração e parar essas iterações sempre que o erro máximo permitido para a posição e a orientação for alcançado, ou quando o número máximo de iterações for alcançado.• Existem quatro critérios a partir dos quais as iterações param:
– erro máximo permitido;– número de iterações;– final do limite físico da junta;– teste do rank da matriz.
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
4. Discretização do caminho
• Discretização linear – O caminho desejado é discretizado em m partes de forma linear, o que faz com que o elemento terminal do robô siga uma linha reta.
• Discretização em semicírculo – O caminho desejado é discretizado em m partes em forma de um semicírculo
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Discretização do caminho em m partes
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Discretização em semicírculo no plano x-y
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Configurações possíveis dos semicírculos
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Sentido crescente (a) e decrescente (b)
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória linear da ferramenta
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória linear da ferramenta
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória da ferramenta realizando um semicírculo (plano x-y) sem
variação de z, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória da ferramenta realizando um semicírculo (plano x-y) sem
variação de z, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-z) sem
variação de y, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-z) sem
variação de y, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano y-z) sem
variação de x, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano y-z) sem
variação de x, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-y) com
variação de z, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-y) com
variação de z, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-z) com
variação de y, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-z) com
variação de y, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano y-z) com
variação de x, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano y-z) com
variação de x, na direção positiva
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-y) com
variação de z (composta de duas partes)
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em semicírculo (plano x-y) com
variação de z (composta de duas partes)
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô (movimento linear composto de duas partes)
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô (movimento linear composto de duas partes)
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em duas partes: movimento linear e um
semicírculo no plano x-y sem variação de z
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Trajetória realizada pela ferramenta do robô em duas partes: movimento linear e um
semicírculo no plano x-y sem variação de z
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
5. Interpolação e filtragem de pontos de passagem no espaço das juntas
• Para gerar uma trajetória a partir de determinados pontos de passagem obtidos pelo operador, no espaço das juntas, torna-se necessária a implementação de algoritmos de interpolação linear.• A interpolação linear da trajetória tem por principal objetivo a criação de uma seqüência de pontos de passagem que interligam os pontos da trajetória inicial dada.• Na filtragem da trajetória interpolada, podem ser utilizados dois tipos de filtragem: na forma triangular e na forma retangular.
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Interpolação e filtragem de pontos de passagem
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Filtro do tipo janela triangular
© 2005 by Pearson Education
Princípios de Mecatrônica – João Maurício Rosário – © 2005 Pearson Education, Inc.
Filtro do tipo janela retangular