cinemática inversa - dan...

15
Cinemática inversa Dan Casas 1

Upload: dothu

Post on 24-Aug-2018

236 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

Cinemática inversa

Dan Casas

1

Page 2: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

2

Cinemática inversa

Page 3: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

3

Cinemática inversa

¿Qué tenemos?

¿Qué queremos?

¿Qué necesitamos?

Posición final

Angulos de rotación

g

En este caso particularEn general

Page 4: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

• Métodos geométricos • Reglas geométricas • Sistemas relativamente sencillos

• Métodos iterativos • Jacobiano • Método aproximado • Sistemas complejos

4

Cinemática inversa

Page 5: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

Método geométrico Por supuesto, el primer paso es asegurarse de que la

posición del objetivo está dentro del alcance del efector de extremo; que es decir:

5

Page 6: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

Las ecuaciones utilizadas en la solución de problemas simples cinemática inversa son:

6

Método analítico

Page 7: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en

función cambios pequeños de

7

Método Incremental: Jacobiano

Page 8: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en

función cambios pequeños de

8

Método Incremental: Jacobiano

Posición final

Angulos de rotación

Page 9: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en

función cambios pequeños de

9

Método Incremental: Jacobiano

Posición final

Angulos de rotación

¿Cómo cambia la coordenada x del punto final e, si incremento un poco?

Page 10: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en

función cambios pequeños de

10

Método Incremental: Jacobiano

Posición final

Angulos de rotación

Page 11: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en

función cambios pequeños de

11

Método Incremental: Jacobiano

Posición final

Angulos de rotación

Page 12: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

12

Método Incremental: Jacobiano

Comportamiento real

(non-linear)

Aproximación lineal

Page 13: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

Problema: ¿Cómo calcular J? Fíjate en una columna de J

Podemos añadir un pequeño incremento y recalcular cómo cambia el punto final Fíjate

13

Método Incremental: Jacobiano

a

Esto resulta en una aproximación numérica

Utilizaremos este método para rellenar el jacobiano J

Page 14: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

while (e está lejos de g) { calcular jacobiano J

calcular pseudoinversa de J —> J+ calcular incrementos en ángulos:

actualizar ángulos }

14

Método Incremental: Jacobiano

g

e

Page 15: Cinemática inversa - Dan Casasdancasas.github.io/teaching/AC-2016/docs/2.2-Cinematica-inversa... · 3 Cinemática inversa ¿Qué tenemos? ¿Qué queremos? ¿Qué necesitamos? Posición

Demo

15