Guía 3 Lab Parametros Denavit - Hartenberg - Software Matlab
Guía 3 Lab Parametros Denavit - Hartenberg - Software Matlab
Guía 3 Lab Parametros Denavit - Hartenberg - Software Matlab
505
GUIA PARA LAS PRÁCTICAS DE VERSIÓN: 2.0
FECHA ULTIMA REVISIÓN:
LABORATORIO, TALLER O CAMPO. 12/04/2017
Nota: El presente documento constituye una recopilación de información de diferentes autores y fuentes
bibliográficas disponibles en el internet; y se utilizará únicamente con fines didácticos: docencia e
investigación. Prohibida su publicación, y su uso con fines comerciales.
A continuación, se encontrará la solución del problema cinemático directo para un robot de las siguientes
características:
Estructura del robot: Cilíndrico
Número de grados de libertad: 4
Tipo: Rotacional-Prismático-Prismático-Rotacional (RPPR)
1. Numerar los eslabones desde 1 (primer eslabón móvil) hasta n (último eslabón móvil). El eslabón 0 es la
base fija del robot.
2. Numerar cada articulación comenzando por 1 (la correspondiente al 1er GDL) y terminando en “n”.
3. Localizar y numerar el eje de cada articulación y etiquetarla, comenzando desde Zo hasta Zn-1.
Si la articulación es rotativa, el eje será su propio eje de giro.
Si la articulación es prismática, el eje será a lo largo del cual se produce el desplazamiento.
Localizar el eje de cada articulación:
Eje de rotación “θ=q”
Eje de desplazamiento o prismática “d=l”)
5. Situar el origen del sistema de la base {So} en cualquier punto del eje Zo. Los ejes Xo e Yo se situarán
de manera perpendicular a Zo.
6. Para i de 1 a n-1, situar el sistema {Si} (solidario al eslabón i) en la intersección del eje Zi con la línea
normal común a Zi y Zi-1.
Si Zi y Zi-1 se cortan, localizar el origen en dicha intersección.
Si Zi y Zi-1 son paralelos, localizar el origen en la articulación i
7. Situar Xi en la línea normal común a Zi y Zi-1. Si los ejes se cortan, se sitúa perpendicular al plano
que forman Zi y Zi-1
Xi COLOR ROJO
Yi COLOR VERDE
Zi COLOR AZUL
9. Situar el sistema {Sn} en el extremo del robot, de modo que Zn coincida con la dirección de Zn-1 y
Xn sea normal a Zn-1 y Zn
10. Obtener θi
El ángulo que hay que girar en torno a Zi-1 para que Xi y Xi-1 queden paralelos (alineados).
Articulación Ɵi di ai αi
1 q1
2 π/2
3 0
4 q4
Figura 7. Obtención del ángulo de giro
11. Obtener di
La distancia medida a lo largo de Zi-1, que hay que desplazar {Si-1} para que xi y xi-1 queden alineados.
Articulación Ɵi di ai αi
1 q1 L1
2 π/2 d2
3 0 d3
4 q4 L4
Figura 8. Obtención de la distancia d
CÓDIGO: SGC.DI.505
GUIA PARA LAS PRÁCTICAS DE VERSIÓN: 2.0
FECHA ULTIMA REVISIÓN:
LABORATORIO, TALLER O CAMPO. 12/04/2017
12. Obtener ai
La distancia medida a lo largo de xi que hay que desplazar el nuevo {Si} para que su origen coincida
con {Si-1} (que ahora coincidiría con xi-1).
Articulación Ɵi di ai αi
1 q1 L1 0
2 π/2 d2 0
3 0 d3 0
4 q4 L4 0
Figura 9. Obtención de la distancia ai
13. Obtener αi
El ángulo que hay que girar en torno a Xi para que el nuevo {Si} coincida totalmente con {Si-1} (que
ahora coincidiría con Xi-1).
Articulación Ɵi di ai αi
1 q1 L1 0 0
2 π/2 d2 0 π/2
3 0 d3 0 0
4 q4 L4 0 0
Figura 10. Obtención de αi
OBJETIVOS:
MATERIALES:
REACTIVOS: INSUMOS:
N/A N/A
EQUIPOS:
Software Matlab
Robotic Toolbox de Matlab
CÓDIGO: SGC.DI.505
GUIA PARA LAS PRÁCTICAS DE VERSIÓN: 2.0
FECHA ULTIMA REVISIÓN:
LABORATORIO, TALLER O CAMPO. 12/04/2017
Nota:
El estudiante será el responsable de obtener los permisos necesarios para uso del software Matlab,
versión educativa.
El software se utilizará únicamente con fines didácticos: docencia e investigación; no se utilizará con
fines comerciales.
Los resultados de la práctica, no se podrá publicar.
MUESTRA:
N/A
INSTRUCCIONES:
Se requiere la correcta comprensión del algoritmo de Denavit - Hartenberg para obtener la misma con la
herramienta “Robotic Toolbox” de Matlab.
Matlab proporciona una valiosa herramienta de apoyo para el desarrollo de cálculos y operaciones habituales
en robótica.
Su capacidad de manipular de manera natural matrices, facilita los cálculos en el modelado de robots. Estas
capacidades se ven aumentadas en la aplicación de Toolbox de Robótica desarrollado por Peter Corke, que
aporta numerosos tipos de datos y operaciones específicas para el modelado de robots.
El Toolbox incluye la función:
Link para la definición de las características cinemáticas mediante los parámetros D-H
SerialLink para la concatenación de las mismas y formar la Matriz de Transformación Homogénea T,
que resuelve el Problema Cinemático Directo.
FUNCIÓN Link. – Permite crear los eslabones del robot. Es un objeto que contiene toda la información del
eslabón de un robot, como sus parámetros cinemáticos, de inercia, de transmisión, etc. (Corke Peter.
2014). Esta función toma como parámetros los elementos de Denavit - Hartenberg, en el siguiente orden:
Offset: En ocasiones se utiliza este parámetro para indicar los posibles desfases en la medida del parámetro
correspondiente al grado de libertad de la articulación y se determina por el ángulo de desfase de Ɵi. Por
ejemplo:
Articulación Ɵi di ai αi offset
2 π/2 d2 0 π/2
3 0 d3 0 0
4 q4 L4 0 0
CÓDIGO: SGC.DI.505
GUIA PARA LAS PRÁCTICAS DE VERSIÓN: 2.0
FECHA ULTIMA REVISIÓN:
LABORATORIO, TALLER O CAMPO. 12/04/2017
FUNCIÓN SerialLink. – Permite unir eslabones; es una clase concreta que representa una serie de vínculos
de tipo brazo robótico. El mecanismo se describe usando los parámetros Denavit - Hartenberg, un conjunto
por par cinemático. (Corke Peter. 2014). El formato es:
r=SerialLink([L1 L2 L3 L4])
Aplicación en Matlab:
Articulación Ɵi di ai αi sigma
1 q1 L1 0 0 0
2 π/2 d2 0 π/2 1
3 0 d3 0 0 1
4 q4 L4 0 0 0
Código en Matlab:
>> a=1;
>> b=0.5;
>> L1=Link([0 a 0 0 0]);
>> L2=Link([pi/2 0 0 pi/2 1]);
>> L3=Link([0 0 0 0 1]);
>> L4=Link([0 b 0 0 0]);
>> r4gdlcil=SerialLink([L1 L2 L3 L4],'name','r4gdlcil')
Cinemática Directa
RESULTADOS OBTENIDOS:
CONCLUSIONES:
RECOMENDACIONES:
FIRMAS