cinemática inversa - dan...
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/1.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/2.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/3.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/4.jpg)
• 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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/5.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/6.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/7.jpg)
• 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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/8.jpg)
• 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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/9.jpg)
• 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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/10.jpg)
• 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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/11.jpg)
• 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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/12.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/13.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/14.jpg)
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](https://reader030.vdocuments.site/reader030/viewer/2022021712/5b7f95017f8b9ae6088c6603/html5/thumbnails/15.jpg)
Demo
15