Your SlideShare is downloading. ×
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Cinematica inversa
Upcoming SlideShare
Loading in...5
×

Thanks for flagging this SlideShare!

Oops! An error has occurred.

×
Saving this for later? Get the SlideShare app to save on your phone or tablet. Read anywhere, anytime – even offline.
Text the download link to your phone
Standard text messaging rates apply

Cinematica inversa

1,153

Published on

0 Comments
0 Likes
Statistics
Notes
  • Be the first to comment

  • Be the first to like this

No Downloads
Views
Total Views
1,153
On Slideshare
0
From Embeds
0
Number of Embeds
2
Actions
Shares
0
Downloads
45
Comments
0
Likes
0
Embeds 0
No embeds

Report content
Flagged as inappropriate Flag as inappropriate
Flag as inappropriate

Select your reason for flagging this presentation as inappropriate.

Cancel
No notes for slide

Transcript

  • 1. CINEMÁTICA INVERSAAline Aparecida de PinaRodrigo Morante Blanco
  • 2. Objetivos •Cinemática direta •Introdução •Representação de Denavit-Hartenberg (D-H) •Cinemática inversa •Introdução •Cálculo do jacobiano •Inversa generalizada •Transposta do jacobiano
  • 3. Cinemática direta (1/5) θ A cinemática direta permite determinar a s: r, localização do e extremo de um membro se conhecidoslar valores das os rticu coordenadas articulares. asa nad r de C ooy x r1 θ1
  • 4. Cinemática direta (1/5) A cinemática direta permite determinar a localização do extremo de um membro se conhecidos os valores das coordenadas articulares. y Coordenadas articulares: r, θ Método geométrico: x = r1 cos θ1 y = r1 sen θ1 r1 ( x, y ) θ1 x
  • 5. Cinemática direta (1/5) A cinemática direta permite determinar a localização do extremo de um membro se conhecidos os valores das coordenadas articulares. y Coordenadas articulares: r, θ ( x, y ) Método geométrico: x = r1 cos θ1 + r2 cos( θ1 + θ2 ) r2 y = r1 sen θ1 + r2 sen( θ1 + θ2 ) θ2 r1 θ1 x
  • 6. Cinemática direta (1/5) A cinemática direta permite determinar a localização do extremo de um membro se conhecidos os valores das coordenadas articulares. y Coordenadas articulares: r, θ ( x, y ) Método geométrico: x = r1 cos θ1 + r2 cos( θ1 + θ2 ) r2 y = r1 sen θ1 + r2 sen( θ1 + θ2 ) θ2 r1 θ1 Esta abordagem não é sistemática x
  • 7. Cinemática direta (2/5) Representação de Denavit-Hartenberg (D-H): 0 0    1   x y
  • 8. Cinemática direta (2/5) Representação de Denavit-Hartenberg (D-H):  1 0 r2  0 0 1 0  0    0 0 1   1    y r2 x
  • 9. Cinemática direta (2/5) Representação de Denavit-Hartenberg (D-H): c θ2 − s θ2 0  1 0 r2  0 s θ c θ2 0 0 1 0  0  2     0  0 1 0 0 1   1    y r2 θ2 x
  • 10. Cinemática direta (2/5) Representação de Denavit-Hartenberg (D-H):  1 0 r1  c θ2 − s θ2 0  1 0 r2  0 0 1 0  s θ c θ2 0 0 1 0  0   2    0 0 1  0   0 1 0 0 1   1    y r2 r1 θ2 x
  • 11. Cinemática direta (2/5) Representação de Denavit-Hartenberg (D-H):  x  c θ1 − s θ1 0 1 0 r1  c θ2 − s θ2 0  1 0 r2  0  y  = s θ c θ1 0 0 1 0  s θ2 c θ2 0 0 1 0  0    1       1  0       0  1 0  1 0 1 0 0 1   0  0   1       0 A1 1 A2 (x,y) y r2 θ2 x r1 θ1
  • 12. Cinemática direta (2/5) Representação de Denavit-Hartenberg (D-H):  x  c(θ1 + θ2 ) − s(θ1 + θ2 ) r1 c θ1 + r2 c(θ1 + θ2 ) 0  y  = s(θ + θ ) c(θ + θ ) r s θ + r s(θ + θ ) 0    1 2 1 2 1 1 2 1 2    1     0 0 1   1   (x,y) y r2 θ2 x r1 θ1
  • 13. Cinemática direta (3/5) Representação de Denavit-Hartenberg (D-H): De esta forma é possível descrever as rotações e translações de um elo do sistema com respeito ao elo anterior. A extensão a 3D é imediata (acrescentado uma linha e uma coluna). Por exemplo: 1 0 0 0 0 c θ − s θ 0 Rotação ao redor do eixo x:   0 s θ c θ 0 0 0 0 1   1 0 0 0 0 1 0 0 Translação paralela ao eixo z:   0 0 1 r 0 0 0 1  
  • 14. Cinemática direta (4/5) Representação de Denavit-Hartenberg (D-H): Em 2D:  x  c(θ1 + θ2 ) − s(θ1 + θ2 ) r1 c θ1 + r2 c(θ1 + θ2 ) 0  y  = s(θ + θ ) c(θ + θ ) r s θ + r s(θ + θ ) 0    1 2 1 2 1 1 2 1 2    1     0 0 1   1   O equivalente em 3D:  x  c(θ1 + θ2 ) − s(θ1 + θ2 ) 0 r1 c θ1 + r2 c(θ1 + θ2 ) 0  y  s(θ + θ ) c(θ + θ ) 0 r1 s θ1 + r2 s(θ1 + θ2 ) 0  = 1 2 1 2   z   0 0 1 0  0  1  0 0 0 1   1     
  • 15. Cinemática direta (5/5) Representação de Denavit-Hartenberg (D-H): Utilizando matrizes de transformação homogênea: •Cada elo do sistema tem associado um sistema de referência •É possível representar as translações e rotações relativas entre vários elos (ou entre todos) •A matriz i −1 A i representa a posição e orientação relativa entre os sistemas associados a dois elos sucessivos A representação total do sistema que serve de exemplo: 0 A 2 = 0 A1 1 A 2 Esta abordagem é sistemática
  • 16. Cinemática inversa (1/9) A cinemática inversa procura determinar os valores das coordenadas articulares se conhecida a localização do extremo do membro. Assim como no caso da cinemática direta, pode-se aplicar métodos geométricos: x = r cos θ   ⇒ θ = atan2( y , x ), r = x + y 2 2 y = r sen θ Para casos mais complexos, resulta muito difícil aplicar este método.
  • 17. Cinemática inversa (2/9) Da cinemática direta temos:    X = f (q ) = T (q ) x onde q é o vetor das coordenadas articulares: q = (r1, θ1,, rn , θn ) O problema dacinemática inversa consiste em encontrar a “inversa” da f tal que  −1  q = f (X)  Devido aos senos & cosenos das rotações, f é não linear em q. Por isso, sua inversa pode não existir ou não ser uma função elementar (arctan, cos,…).
  • 18. Cinemática inversa (3/9) A idéia é utilizar uma aproximação linear da função e achar sua “inversa”:   f (q ) = f (q0 ) + J (q0 )(q − q0 ) (Taylor) onde J (q0 ) é o jacobiano da função no ponto q0 e a aproximação anterior é válida perto desse ponto. y Aproximada Exata x
  • 19. Cinemática inversa (4/9) Cálculo do jacobiano: Precisamos calcular o jacobiano e logo “invertê-lo”.  As colunas do jacobiano são as derivadas parciais de f no ponto q0. Como da representação de D-H temos   f (q ) = R1T1 RnTn x onde só Ri depende de θ i e só Ti depende de ri , pela regra do produto as derivadas parciais são calculadas como sendo:   ∂ θ f (q ) = R1T1 Ri i ′Ti  RnTn x,   ∂ r f (q ) = R1T1  RiTi ′RnTn x. i Por isso é necessário derivar matrizes de rotação e translação.
  • 20. Cinemática inversa (5/9) Cálculo do jacobiano: Derivada de uma matriz de rotação R: RR T = 1 ⇒ R ′ R T + R(R ′)T = 0 ⇒ R ′ R T = −(R ′ R T )T Então a velocidade angular Ω = R ′ R T é uma matriz antissimétrica, que está relacionada com o eixo de rotação  ω = ( ω x , ω y , ωz ) via  0 − ωz ω y 0   ω 0 − ωx 0 Ω= z   − ωy ωx 0 0  0 0 0 0   Finalmente, R ′ = R ′R T R = ΩR.
  • 21. Cinemática inversa (6/9) Cálculo do jacobiano: Derivada de uma matriz de translação T: Por exemplo: 1 0 0 0 0 0 0 0 0 1 0 r 0 0 0 1 T =  ⇒ T′ =   0 0 1 0 0 0 0 0 0 0 0 1 0 0 0 0    
  • 22. Cinemática inversa (7/9) Cálculo do jacobiano: Retomando nosso exemplo, se  x  c θ1 − s θ1 0 1 0 r1  c θ2 − s θ2 0  1 0 r2  0  y  = s θ c θ1 0 0 1 0  s θ2 c θ2 0 0 1 0  0    1       1  0    0 1 0 0 1  0   0 1 0 0 1  1    então o jacobiano resulta ser: c θ1 − r2 s(θ1 + θ2 ) − r1 s θ1 c(θ1 + θ2 ) − r2 s(θ1 + θ2 ) J = s θ1 r2 c(θ1 + θ2 ) + r1 c θ1 s(θ1 + θ2 ) r2 c(θ1 + θ2 )     0  0 0 0   O vetor das coordenadas articulares é q = (r1, θ1, r2 , θ2 )
  • 23. Cinemática inversa (8/9) Inversa generalizada: A inversa do jacobiano é tal que, dada uma pequena variação da posição do extremo, é possível calcular a variação nas coordenadas articulares: ∆q = J −1 ∆x Em geral, não existe a inversa do jacobiano, mas sim uma inversa generalizada B, que cumpre alguma das condições de Moore-Penrose: 1. JBJ = J 2. BJB = B 3. (JB )T = JB 4. (BJ )T = BJ Se B cumpre todas as quatro condições, é dita pseudo- inversa, e é única: B = J + Achar a inversa generalizada é um processo lento e que não lida adequadamente com singularidades.
  • 24. Cinemática inversa (9/9) Transposta do jacobiano: Em lugar de utilizar a pseudo-inversa do jacobiano, pode-se utilizar a transposta: ∆q = J T ∆x É muito mais barato e ainda por cima evita problemas com singularidades. Esta aproximação é motivada por considerações físicas (“trabalho virtual”). Para resolver certos problemas de escala, pode-se introduzir um fator de escala h, e iterar até atingir a convergência: ∆q ( i +1) = h J T ∆x ( i )
  • 25. Referências Cinemática Inversa: •Fast Numerical Methods for Inverse Kinematics, Bill Baxter •Cinemática del robot, Amador Matrizes em geral: •Matrix Computations, Gene H. Golub & Charles F. Van Loan

×