Resolved Motion Control. Prof. Walter Fetter Lages 9 de maio de 2019

Documentos relacionados
Introdução. Walter Fetter Lages

Introdução. Walter Fetter Lages

Modelo Cinemático Inverso. Prof. Walter Fetter Lages 16 de setembro de 2007

Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Engenharia Elétrica ENG04479 Robótica A. Controle de Manipuladores

SEM Controle de Sistemas Robóticos

Cinemática Inversa de Manipuladores

Introdução à Robótica Industrial p. 1/23

2 Velocidade do Centro de Massa dos Elos

Aula 2 - Planejamento de Trajetória, Controle PID e UArm II

Walter Fetter Lages. Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Engenharia Elétrica ENG04479 Robótica A

Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Engenharia Elétrica ENG04037 Sistemas de Controle Digitais

Controle Linear Controle Não-Linear Controle Adaptativo Exercícios Recomendados Bibliografia Recomendada 2/145

Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Engenharia Elétrica ENG04037 Sistemas de Controle Digitais

Introdução à Robótica Industrial p. 1/25

ESCOLA POLITÉCNICA DA UNIVERSIDADE DE SÃO PAULO. Departamento de Engenharia Mecânica

Programa Analítico de Disciplina ELT434 Robótica Industrial

UNIVERSIDADE DE CAXIAS DO SUL CURSO DE ENGENHARIA DE CONTROLE E AUTOMAÇÃO RODRIGO REIS ROSSI PLATAFORMA DE STEWART APLICADA A UM SISTEMA BOLA CHAPA

MESTRADO INTEGRADO EM ENG. INFORMÁTICA E COMPUTAÇÃO 2011/2012. EIC0010 FÍSICA I 1o ANO 2 o SEMESTRE

1 Problema Cinemático Inverso

Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Engenharia Elétrica ENG04037 Sistemas de Controle Digitais

Modelagem Cinemática de Robôs Industriais. Prof. Assoc. Mário Luiz Tronco

4. Análise cinemática dos mecanismos selecionados para o quadril e tornozelo

Transmitir aos alunos conhecimentos sobre robótica fixa e móvel, visando capacitá-los a desenvolver

Cinemática Inversa (numérica) Douglas Wildgrube Bertol DEE - Engenharia Elétrica CCT

Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Engenharia Elétrica ENG04037 Sistemas de Controle Digitais

ROBÓTICA PLANEJAMENTO DE TRAJETÓRIAS. Prof a. Dra. GIOVANA TRIPOLONI TANGERINO Tecnologia em Automação Industrial

1- INTRODUÇÃO AOS ROBÔS INDUSTRIAIS MODELAGEM GEOMÉTRICA

Robótica Competitiva Controle de Movimento Cinemático

4. ESTÁTICA E DINÂMICA

PROGRAD / COSEAC Padrão de Respostas Física Grupo 04

1. Realimentação de Estado: sistemas MIMO

Pontifícia Universidade Católica do Rio de Janeiro / PUC-Rio Departamento de Engenharia Mecânica. ENG1705 Dinâmica de Corpos Rígidos.

Problemas 21/03/2012. (b) Como mostramos no item (a), as componentes do vetor posição ( r) são: x = t 2

Engenharia de Controle e Automação: ENG03316 Mecanismos I Engenharia Elétrica: ENG10017 Sistemas e Sinais e ENG04475 Microprocessadores I

CAPÍTULO 5. Considere-se uma matriz de rotação variante no tempo R = R(t). Tendo em vista a ortogonalidade de R, pode-se escrever

Exercício Resolvido Cinemática direta para o manipulador Stanford

PROGRAD / COSEAC Padrão de Respostas Física Grupos 05 e 20

Introdução à Robótica Industrial p. 1/20

Instrumentação e Controle Aula 14. Prof. Renato Watanabe ESTO004-17

EES-20: Sistemas de Controle II. 21 Agosto 2017

Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Sistemas Elétricos de Automação e Energia ELE228 Robótica A.

MODELAÇÃO E SIMULAÇÃO MEEC IST, TESTE N0.1 TIPO V02. Consider o sistema dinâmico descrito pela equação diferencial

Mecânica Clássica 1 - Lista 2 Professor: Gabriel T. Landi

Mecânica Analítica. O Princípio de Hamilton. J. Seixas. Mecânica Analítica (Módulo 1)

PEF 3302 Mecânica das Estruturas I Segunda Prova (22/11/2016) - duração: 160 minutos Resolver cada questão em uma folha de papel almaço distinta

CIRCUNFERÊNCIA TRIGONOMÉTRICA

Manipulação Robótica. Aula 2

1 Objetivo. 2.1 Compensador de Avanço e de Atraso de Fase

Introdução à Robótica Industrial. Aula 2

MESTRADO INTEGRADO EM ENG. INFORMÁTICA E COMPUTAÇÃO 2015/2016

Modelagem no Domínio do Tempo

Cinemática de Robôs Móveis

SISTEMAS DE OSCILADORES

Controle de Robôs Manipuladores

Escola Politécnica da Universidade de São Paulo Departamento de Engenharia Mecânica

6 Controlador de Estado

Capítulo 1 INTRODUÇÃO

ROBÓTICA CINEMÁTICA. Prof a. Dra. GIOVANA TRIPOLONI TANGERINO Tecnologia em Automação Industrial

Anfranserai M. Dias, Pablo J. Alsina Universidade Federal do Rio Grande do Norte, DCA - CT - UFRN Lagoa Nova, Cep.: Natal, RN, Brasil

Estudo comparativo de estratégias de controle de robôs manipuladores no espaço de juntas

Prova tipo A. Gabarito. Data: 8 de outubro de ) Decida se cada afirmação a seguir é verdadeira ou falsa. 1.a) Considere os vetores de R 3

Lista 3 - FIS Relatividade Geral Curvatura, campos de Killing, fluidos, eletromagnetismo.

Equações do Movimento

SME Cálculo Numérico. Lista de Exercícios: Gabarito

Capítulo 2 Vetores. 1 Grandezas Escalares e Vetoriais

Álgebra Linear Exercícios Resolvidos

Introdução ao Controle em Espaço de Estados - Escrevendo as Equações de Estado

Solução Numérica de EDOs

étodos uméricos ZEROS DE FUNÇÕES DE UMA OU MAIS VARIÁVEIS Prof. Erivelton Geraldo Nepomuceno PROGRAMA DE PÓS-GRADUAÇÃO EM ENGENHARIA ELÉTRICA

Mecânica Técnica. Aula 2 Lei dos Senos e Lei dos Cossenos. Prof. MSc. Luiz Eduardo Miranda J. Rodrigues

: v 2 z = v 2 z0 2gz = v 2 0sen 2 θ 0 2gz. d = v 0 cosθ 0.t i) v0sen 2 2 θ 0 = 2g ii) v 0 senθ 0 =gt iii)

Robótica. Prof. Reinaldo Bianchi Centro Universitário FEI 2016

CAPÍTULO 6 DINÂMICA DO MANIPULADOR

3 Implementação Computacional

ROBÓTICA SISTEMAS DE REFERÊNCIA. Prof a. Dra. GIOVANA TRIPOLONI TANGERINO Tecnologia em Automação Industrial

MESTRADO INTEGRADO EM ENG. INFORMÁTICA E COMPUTAÇÃO 2015/2016

Modelagem Cinemática de Robôs Industriais. Prof. Assoc. Mário Luiz Tronco

Robótica - utilização, programação, modelagem e controle de robôs industriais

Capítulo 12. Projeto no Espaço de Estados

ROBÓTICA (ROB74) AULA 1. INTRODUÇÃO A ROBÓTICA PROF.: Michael Klug

Apresentação Robótica

MODELAGEM CINEMÁTICA DE UM ROBÔ ANTROPOMÓRFICO COM DOIS GRAUS DE LIBERDADE 1

Segundo Exercício de Modelagem e Simulação Computacional Maio 2012 EMSC#2 - MECÂNICA B PME 2200

Vibrações Mecânicas. Sistemas com 2 Graus de Liberdade DEMEC/CTG/UFPE. Ramiro Brito Willmersdorf

Descrições e Transformações Espaciais. Prof. Walter Fetter Lages 21 de junho de 2007

Revisão II: Sistemas de Referência

1 ạ Lista de Exercícios/Trabalho de Controle Não Linear Prof. Paulo Sergio 2018

Matemática Matrizes e Determinantes

6 MÉTODO DE ELEMENTOS FINITOS - MEF

Exemplos de aplicação das leis de Newton e Conservação da Energia

REVISÃO DE ANÁLISE TENSORIAL

Tópicos de Física Clássica I Aula 2 As equações de Euler-Lagrange

1) (Unicamp) Três planos de telefonia celular são apresentados na tabela abaixo:

VETORES. DEFINIÇÃO DE GRANDEZA É tudo aquilo que pode ser medido Exemplos: Comprimento Aceleração Força Velocidade

Jacobiano no ROS. Walter Fetter Lages

Realimentação de Estado Sistemas SISO

massa do corpo A: m A ; massa do corpo B: m B ; massa da polia: M; raio da polia: R; adotando a aceleração da gravidade: g.

Transcrição:

Universidade Federal do Rio Grande do Sul Escola de Engenharia Departamento de Sistemas Elétricos de Automação e Energia ENG10051 Dinâmica e Controle de s Controle no espaço cartesiano Resolved Motion Control Prof. Walter Fetter Lages 9 de maio de 2019 Resolved motion o movimento de todas as juntas é combinado e resolvido em movimentos da garra controláveis separadamente nas coordenadas cartesianas Trajetória (referência) especificada no espaço das cartesiano Atuação no espaço das juntas base R garra P x v x P y v y P z ω v z x ω x ω y ω y ω z ω z P x P y P z α β γ v x v y v z α β γ C γ S γ 0 C β 0 S β 1 0 0 S γ C γ 0 0 1 0 0 C α S α 0 0 1 S β 0 C β 0 S α C α C γ C β S γ C α +C γ S β S α S γ S α +CγS β C α S γ C β C γ C α +S γ S β S α C γ S α +S γ S β C α S β C β S α C β C α V ν J() Jacobiano geométrico [ VΦ Ẋ J a() Jacobiano analítico 1

I 0 ν T 0 T(φ) a (φ)ẋ cosγcosβ senγ 0 T(φ) senγcosβ cosγ 0 senβ 0 1 Se o jacobiano for inversível (caso típico em robôs com 6 graus de liberdade) 1, pode-se escrever V J 1 () (1) portanto, as acelerações serão V J(, ) +J() (2) Substituindo-se (1) em (2) tem-se V J(, V )J 1 () +J() de onde pode-se obter uma forma de calcular as velocidades e acelerações das juntas em função das velocidades e acelerações cartesianas. V J 1 () J 1 () J(, V )J 1 () (3) 1 Resolved Motion Rate Control As juntas movem-se de modo a manter um movimento de regime da garra. X fk() X P x P y P z 1 Caso o Jacobiano não seja inversível, pode-se utilizar uma pseude-inversa, dada porj () J T () ( J()J T () ) 1. 2 α β γ

[ VΦ Ẋ J a () J 1 a ()Ẋ A figura 1 mostra um diagrama de blocos do resolved motion rate control. ẋ d J 1 () Controlador de juntas J() Figura 1: Diagrama de blocos do resolved motion rate control. Pode-se também desejar manter constate as velocidades no sistema da garra e não no sistema da base. Neste caso [ 0 Ẋ 0 R G Ġ Ja 1 R () G 0 0 0 Ġ R G 2 Resolved Motion Acceleration Control n s a p H 0 0 0 1 n H d d s d a d p d 0 0 0 1 e p p d p e o 1 [ n n d +s s d +a a d 2 [ VΦ Ẋ J a () 3

Definindo-se e se for possível fazer tem-se Ẍ J a () + J a (, ) (4) e [ ep e o (Ẋd ) Ẍ Ẍd +K d Ẋ +K p e (5) ë+k d ė+k p e 0 ue pode ter a sua dinâmica arbitrariamente determinada ajustando-se os valores K p e K d. Resta, portanto, garantir ue (5) seja satisfeita. De (4) e (5) pode-se garantir isto fazendo-se [Ẍd (Ẋd ) Ja 1 () +K d Ẋ K d +J 1 a () +K p e J a (, ) [Ẍd +K d Ẋ d +K p e J a (, ) (6) Pode-se, então, utilizar, por exemplo, o formalismo de Newton-Euler para calcular os torues ue precisam ser aplicados nas juntas para forçar a aceleração computada por (6). A figura 2 mostra um diagrama de blocos do resolved motion acceleration control. 3 Resolved Motion Force Control Determina os torues necessários para realizar um movimento cartesiano não utiliza o modelo dinâmico e compensa variações de configuração e gravidade Necessita de um sensor de força na garra O controle de posição determina os torues necessários na garra para ue uma certa trajetória seja rastreada O controle de força convergente determina os torues nas juntas para ue os torues na garra sejam os desejados 4

X d X 0 T n () e K p Ẋ d K d Ẍ d + J 1 () + Newton Euler K d J(, ) Figura 2: Diagrama de blocos do resolved motion acceleration control. J T a ()F a F x F y F a F z x y z De forma semelhante a seção 2, se for possível fazer com ue (Ẋd ) Ẍ Ẍd +K d Ẋ +K p e (7) tem-se ë+k d ė+k p e 0 5

ue, da mesma forma, pode ter a sua dinâmica arbitrariamente determinada ajustando-se os valores K p e K d. No entanto, aui, satisfaz-se (7) garantido ue a força na garra seja dada por F d a MẌ (8) Por sua vez, (8) é garantida fazendo-se com ue o torue aplicado nas juntas seja dado por ondem é a matriz de inércia da carga, dada por mi3 3 0 M 0 I J T ()F d J T ()MẌ (9) sendo I 3 3 a matriz identidade3 3 ei o tensor de inércia da carga. As expressões (7) e (9) descrevem o laço de de posição do resolved motion force control, como mostrado na figura 3. Ẍ d Ẍ F d M J T () K p +K d s X d 0 T n () Figura 3: Diagrama de blocos do laço de posição do resolved motion force control. A lei de controle descrita por (7) e (9) funciona bem se M for desprezível em comparação com a inércia do manipulador em sí. No caso geral, parte do torue (9) é gasta com o próprio manipulador. Para compensar isto, é utilizado o controle de força convergente. Este método consiste em fazer-se aproximações da forma F a (k) F d a (k) F o(k) 6

F a (k +1) F a (k)+γ k F a (k) γ k 1 k+1, k 0,1,2,...N com F a (0) F o. TipicamenteN 2 é suficiente. A figura 4 mostra um diagrama de blocos completo do resolved motion force control, incluindo o controle de posição e o controle de força convergente. Ẍ d Ẍ M F d F γ k F a J T () K p +K d s F o Sensor de força X d 0 T n () Figura 4: Diagrama de blocos completo do resolved motion force control. 7