ROBÓTICA (ROB74) – AULA 4 CINEMÁTICA INVERSA DE MANIPULADORES SERIAIS PROF.: Leo Schirmer.
Cinemática inversa - Dandancasas.github.io/teaching/AC-2019/docs/2.2-Cinematica-inversa-v… ·...
Transcript of Cinemática inversa - Dandancasas.github.io/teaching/AC-2019/docs/2.2-Cinematica-inversa-v… ·...
Cinemática inversa
Dan Casas
1
2
Cinemática inversa
3
Cinemática inversa
¿Qué tenemos?
¿Qué queremos?
¿Qué necesitamos?
Posición final
Angulos de rotación
g
En este caso particularEn general
• Métodos geométricos • Reglas geométricas • Sistemas relativamente sencillos
• Métodos iterativos • Jacobiano • Método aproximado • Sistemas complejos
4
Cinemática inversa
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
Las ecuaciones utilizadas en la solución de problemas simples cinemática inversa son:
6
Método analítico
• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en
función de cambios pequeños de
7
Método Incremental: Jacobiano
Método Incremental: JacobianoEl end effector se mueve iterativamente hasta que la configuración final se alcanza dentro de una tolerancia dada.
8
Vamos a minimizar en función de esta expresión
g
e
g
Utilizaremos el Jacobian para saber como modificar para que esta expresión acabe siendo próxima a 0
• 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
• 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
¿Cómo cambia la coordenada x del punto final e, si incremento un poco?
• 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
Derivadas de e respecto
• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en
función cambios pequeños de
12
Método Incremental: Jacobiano
Posición final
Angulos de rotación
• Jacobiano ‣ Matriz de derivadas parciales ‣ Define como la posición e se mueve en
función cambios pequeños de
12
Método Incremental: Jacobiano
Posición final
Angulos de rotación
Hacia dónde quiero ir
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
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
(g - e)
Demo
15