Cinemática Directa Brazo Robótico 3DOF
Cinemática Directa Brazo Robótico 3DOF
[Link]@[Link]
mauriciovivas12@[Link]
Certifico que el presente trabajo de integración curricular fue desarrollado por MAURICIO
ALEJANDRO LANDÍVAR VIVAS, bajo mi supervisión.
[Link]@[Link]
I
DECLARACIÓN DE AUTORÍA
II
DEDICATORIA
El proyecto realizado está dedicado a mi madre que en todo este tiempo me ha brindado
mucho apoyo en el trayecto de la carrera, me ha enseñado que la vida continua a pesar de
los malos momentos y que mantener una buena actitud en cualquier circunstancia puede
mejorar las cosas. A mi amiga Litzy Yánez por acompañarme y haberme brindado todo el
apoyo que necesitaba en mi proceso de formación académica.
III
AGRADECIMIENTO
Agradezco a mi familia por haberme inculcado valores primordiales que necesita tener una
persona de bien. Por los momentos que hemos vivido tantos buenos y malos, que me han
brindado enseñanzas de cómo afrontar las diferentes situaciones que se presentan en la
vida.
Agradezco a mi tía que me acompaño toda mi vida y me brindo todo su cariño y me ayudo
en mis momentos de reflexión, ser una amiga con la que puedo contar en cualquier
momento.
Agradezco mucho la ayuda de mi mejor amigo Josué y su familia Santamaría que me han
brindado apoyo y pude compartir grandes momentos, por brindarme su ayuda en
momentos difíciles que han sucedido en mi vida, aunque por la distancia no estén
presentes siempre me recuerdan que cuento con ellos en cada momento.
IV
ÍNDICE DE CONTENIDO
CERTIFICACIONES ................................................................................................ I
DECLARACIÓN DE AUTORÍA............................................................................... II
AGRADECIMIENTO .............................................................................................. IV
2 METODOLOGÍA .............................................................................................. 8
2.4 Manual instructivo para la simulación del brazo robótico Pincher X-100. ...... 31
3 RESULTADOS............................................................................................... 32
4 CONCLUSIONES .......................................................................................... 35
5 RECOMENDACIONES .................................................................................. 37
V
7 ANEXOS ........................................................................................................ 41
VI
RESUMEN
En el capítulo 3 se adjuntan las pruebas y resultados del funcionamiento del robot virtual y
su cinemática (cálculo del error relativo porcentual).
Por último, en el capítulo 7 se encuentran los anexos de los planos y esquemas, pruebas
de funcionamiento de la simulación del modelo Pincher X-100 en el entorno de Simulink y
Autodesk Inventor, códigos de programación.
VII
ABSTRACT
In this Curricular Integration Work, the equations describing the kinematic behavior of a
Pincher X-100 robotic arm with 3 degrees of freedom are modeled in three dimensions (3D)
and the equations describing the kinematic behavior of a robotic arm with 3 degrees of
freedom are established.
In the structure of the project the following chapters have been established:
Chapter 1 contains the description of the developed component, the general objective,
specific objectives, scope and theoretical framework. In the theoretical section, the following
important descriptions for the project are shown: robotics, robotic arm, link, joint, end-
effector, direct kinematics and the Denavit-Hartenberg representation.
Chapter 2 shows the methodology used, where the export, modeling and assembly of the
parts that make up the robotic arm are presented. Likewise, the analysis of the direct
kinematics and an instructive manual for the simulation of the Pincher X-100 model are
shown.
Chapter 3 contains the tests and results of the operation of the virtual robot and its
kinematics (calculation of the relative percentage error).
Chapters 4 and 5 present the conclusions and recommendations reached during the
development of the project. Also, Chapter 6 contains the bibliographical references used in
the theoretical framework and as a guide for the equations.
Finally, Chapter 7 contains the annexes of the drawings and schematics, functional tests of
the simulation of the Pincher X-100 model in the Simulink and Autodesk Inventor
environment, and programming codes.
VIII
1 DESCRIPCIÓN DEL COMPONENTE DESARROLLADO
Una de las áreas que se encuentra en múltiples industrias es la Robótica, la cual es de
suma importancia en el presente y futuro para el desarrollo de las industrias, puesto que
los robots o manipuladores seguirán ganando terreno en las líneas de producción, de esta
manera se tendrán robots al servicio de las industrias aeroespacial, química, alimenticia,
textil, minería, mecánica, etc., lo que facilitará la elaboración de productos que tengan
características repetitivas, incrementando así la producción, calidad del producto y
eficiencia del trabajo.
Para realizar la simulación del mecanismo se utiliza el software de diseño y dibujo llamado
Inventor, el cual en la actualidad ayuda a la optimización de costes de materiales y
visualización en tiempo real, facilitando la creación de prototipos con dibujos o modelado
2D y 3D. Este software se utilizó para identificar los elementos que conforman el brazo
robótico, además de los eslabones del mecanismo que facilitaron el ensamblaje final del
brazo.
Se descargaron las librerías necesarias para la vinculación de programas, de tal forma que
permita la exportación de archivos como el ensamblaje final, para obtener el modelamiento
en un entorno de trabajo de un software computacional matemático.
Matlab permite el diseño de control, robótica y otros campos gracias a que tiene un entorno
de diagramas de bloques que permiten la simulación, como el diseño de modelos usando
códigos de programación conocido como Simulink.
Se presenta el proceso para la simulación del modelo Pincher X-100 ingresando ángulos
de giro que se colocan en una interfaz, mostrando la posición del efector final de manera
gráfica, con el objetivo de que el usuario observe el mecanismo modelado.
1
1.1 Objetivo general
1.3 Alcance
2
1.4 Marco teórico
Robótica
Brazo robótico
Es un robot serie que puede aplicar funciones parecidas a las que desempeña un brazo
humano, pero con la diferencia que se lo puede programar para que lleve a cabo una
actividad específica; además de que puede resistir cargas más altas que las de un brazo
humano (Figura 1.2.) [2].
3
Los elementos de un brazo robótico son:
Eslabones: Son las partes rígidas del robot, las cuales se encuentran enlazadas entre sí
por medio de articulaciones (Figura 1.3.) [3].
• Lineal: El eslabón se desliza sobre un eje al eslabón anterior (Figura 1.4. (a)).
• Rotacional: El eslabón gira en torno a un eje al eslabón anterior (Figura 1.4. (b)).
4
Figura 1.5. Ejemplo de grados de libertad de un brazo robótico.
Efector final: Eslabón unido al final de toda la cadena cinemática del brazo robótico.
(Figura 1.6.) [1]
Cinemática directa
Consiste en encontrar el valor de la posición del efector final del brazo articulado
robóticamente, esta es una solución que recopila los valores articulares, es decir, el valor
rotativo como de desplazamiento. Por lo que existen dos métodos para encontrar dicha
solución los cuales son:
5
Figura 1.7 Método geométrico.
Desarrollando el modelo matemático de matrices que tiene este método, que admite un
punto de referencia de elemento 𝑖 con respecto al sistema del elemento 𝑖 − 1 [8].
Se tiene las siguientes matrices de desarrollo que se usan en este método, las cuales son:
cos 𝜃𝑖 −sin 𝜃𝑖 0 0
sin 𝜃𝑖 cos 𝜃𝑖 0 0]
𝐴 𝑇(𝑧,𝜃𝑖) =[
0 0 1 0
0 0 0 1
1 0 0 0
𝐴 𝑇(0,0,𝑑𝑖) = [0 1 0 0]
0 0 1 𝑑𝑖
0 0 0 1
1 0 0 𝑎𝑖
𝐴 𝑇(𝑎𝑖,0,0) = [0 1 0 0]
0 0 1 0
0 0 0 1
6
Rotación alrededor del eje 𝑋𝑖 a un ángulo 𝛼𝑖 .
1 0 0 0
0 cos 𝛼𝑖 −sin 𝛼𝑖 0
𝐴 𝑇(𝑥,𝛼𝑖) =[ ]
0 sin 𝛼𝑖 cos 𝛼𝑖 0
0 0 0 1
Parámetros Denavit-Hartenberg:
7
2 METODOLOGÍA
Para el desarrollo del proyecto de integración curricular se consideran: planos CAD,
librerías, programas, etc. Por lo que, se investigaron páginas con información acerca del
brazo robótico modelo Pincher X-100 en archivos tipo (.dwg) (AutoCad) como (.step)
(Autodesk Inventor) para programas que tengan software acerca de diseño y dibujo. En
Autocad se realizó una investigación de las respectivas longitudes que tiene el brazo por
cada eslabón que lo conforma.
En el software de Autodesk Inventor se ejecutan archivos (.step) que contienen las piezas
en 3D, además de realizar la conformación de partes que lo componen, como la edición de
cada pieza (color, ubicación, entre otras.).
El brazo robótico se conformó por 7 eslabones que se obtuvieron del mismo plano
descargado de la página consultada en la web [22], de esta manera, se realizó la
estructuración tomando en cuenta las restricciones de inserción para que el brazo pueda
moverse en cualquiera de sus ejes.
Una vez realizado el ensamblaje, se descargó la librería ¨Simscape Multibody Link¨ que
contiene la vinculación Autodesk Inventor con Simulink en el entorno de Matlab. Con esta
información, se exportó el modelo Pincher X-100, obteniéndose la simulación del brazo en
Simulink en el entorno de Matlab.
8
2.1 Modelo del brazo robótico
Figura 2.1. Descarga de planos 3D formato STEP del brazo robótico Pincher X-100.
Además, se utilizaron datos del plano CAD de formato (.dwg). Se ejecutó el software
Autocad que permitió visualizar su estructura como se observa en el Anexo II.
9
Modelo del brazo robótico Pincher X-100 en el entorno de Autodesk Inventor
y Matlab.
Con el plano 3D del brazo robótico modelo Pincher X-100 descargado se procedió a la
importación en Autodesk Inventor (Figura 2.2).
10
Figura 2.4. Selección del formato para la ejecución del plano 3D.
Se buscó la carpeta con el archivo tipo ¨STEP¨ del brazo robótico y se finalizó con la opción
¨Abrir¨ (Figura 2.5).
Figura 2.5. Elección del archivo STEP que contiene el plano 3D del brazo robótico.
Por defecto del programa aparece la estructura 3D del brazo modelo Pincher X-100 en el
entorno de Autodesk Inventor. (Figura 2.6)
11
Figura 2.6. Ilustración del brazo robótico Pincher X-100 3D.
Conformación de eslabones.
Para la conformación de eslabones se realizó una división en piezas. Cada una de las
piezas se almacenan por separado (Figura 2.7).
Una vez seleccionado el elemento (Figura 2.7) se escogió la opción ¨Cuerpos sólidos¨ que
desglosa ¨Sólido 1¨, se da clic derecho y se eligió la opción ¨Crear componentes¨ que dirige
a una nueva ventana de propiedades (Figura 2.8).
12
Figura 2.8. Opción para la conformación de la pieza.
Esta ventana permitió guardar cada pieza de manera individual. Las consideraciones son:
proporcionar un nombre y una dirección en el equipo (Figura 2.9).
13
Figura 2.10. Eslabón 0 creado del brazo robótico.
14
Ensamble de la Pieza 1
15
Se escogió el eslabón 0 con el eje de la pieza 1 (Figura 2.14).
Figura 2.14. (a) Centro del eslabón 0 (b) Eje de la pieza 1 (c) Ensamble final.
Ensamble de la Pieza 2
Se ejecutó la opción insertar y se seleccionó la pieza 2, luego ¨R¨ con la opción ¨T-I¨ (Figura
2.15).
16
Figura 2.16. (a) Eje del eslabón 1 (b) Centro de la pieza 2 (c) Ensamble final.
Ensamble de la Pieza 3
Se ejecutó la opción insertar y se seleccionó la pieza 3, luego ¨R¨ con la opción ¨T-I¨ (Figura
2.17).
Figura 2.18. (a) Eje del eslabón 2 (b) Centro de la pieza 3 (c) Ensamble final.
Ensamble de la Pieza 4
Se ejecutó la opción insertar y se seleccionó la pieza 4, luego ¨R¨ con la opción ¨T-I¨ (Figura
2.19).
17
Figura 2.19. Elaboración del cuarto eslabón en Autodesk Inventor.
Figura 2.20. (a) Eje del eslabón 3 (b) Centro de la pieza 4 (c) Ensamble final.
Por último, se consiguió el ensamblaje del modelo Pincher X-100 (Figura 2.21).
Se continuó con el enlace: Simscape Multibody Link download page [23] para la descarga
de la librería ¨Simscape Multibody Link¨.
18
Se escogió la versión actual que se encuentra al principio de la lista (Figura 2.22).
19
Figura 2.24. Selección de la opción Administrador para el inicio de Matlab.
20
Figura 2.27. Procedimiento de instalación.
La exportación del ensamblaje del brazo robótico modelo Pincher X-100 se obtuvo en
Autodesk Inventor en la pestaña ¨Complementos¨, se seleccionó la opción ¨Export
Simscape Multibody¨ (Figura 2.29).
21
Figura 2.29. Exportación del brazo robótico mediante la opción Export Simscape
Multibody Link.
22
Figura 2.31. Diagrama de bloques del brazo robótico obtenido en la importación.
Para la obtención del modelo matemático se usó el método de D-H que se describió en la
sección 1.4.
En la tabla 2.1 se muestran los datos de D-H que se obtuvieron al realizar el análisis que
se especifica en la sección 1.4.
23
Tabla 2.2. Parámetros Denavit-Hartenberg
Parámetros de Articulación 𝜃𝑖 𝑑𝑖 𝑎𝑖 𝛼𝑖
1 90 - - -
2 𝑞1 𝑙1 - -
3 - - - 90
4 𝑞2 - - -
5 - - - 270
6 - 𝑙2 - -
7 - - - 90
8 - - 𝑙3 -
9 𝑞3 - 𝑙4 -
10 𝑞4 - 𝑙5 -
cos(𝜃1 ) −sin(𝜃1 ) 0 0
)
𝐴10 = [ sin(𝜃1 ) cos(𝜃1 0 0]
0 0 1 0
0 0 0 1
Donde:
𝜃1 : 90 (°)
cos(𝜃2 ) −sin(𝜃2 ) 0 0
sin(𝜃2 ) cos(𝜃2 ) 0 0
𝐴12 = [ ]
0 0 1 𝑙1
0 0 0 1
Donde:
24
𝑙1 : 8.945 (𝑐𝑚)
𝜃2 : 𝑞1 (°)
1 0 0 0
0 cos(𝛼3 ) −sin(𝛼3 ) 0
𝐴23 = [ ]
0 sin(𝛼3 ) cos(𝛼3 ) 0
0 0 0 1
Donde:
𝛼3 : 90 (°)
cos(𝜃4 ) −sin(𝜃4 ) 0 0
𝐴34 = [ sin(𝜃4 ) cos(𝜃4 ) 0 0]
0 0 1 0
0 0 0 1
Donde:
𝜃4 : 𝑞2 (°)
1 0 0 0
0 cos(𝛼5 ) −sin(𝛼5 ) 0
𝐴45 = [ ]
0 sin(𝛼5 ) )
cos(𝛼5 0
0 0 0 1
Donde:
𝛼5 : 270 (°)
cos(𝜃6 ) −sin(𝜃6 ) 0 0
sin(𝜃6 ) cos(𝜃6 ) 0 0]
𝐴56 = [
0 0 1 𝑙2
0 0 0 1
25
Donde:
𝑙2 : 10 (𝑐𝑚)
𝜃6 : 0 (°)
1 0 0 0
0 cos(𝛼7 ) −sin(𝛼7 ) 0
𝐴67 = [ ]
0 sin(𝛼7 ) cos(𝛼7 ) 0
0 0 0 1
Donde:
𝛼7 : 90 (°)
Donde:
𝑙3 : 3.5 (𝑐𝑚)
𝜃8 : 0 (°)
Donde:
𝑙4 : 10 (𝑐𝑚)
𝜃9 : 𝑞3 (°)
26
cos(𝜃10 ) −sin(𝜃10 ) 0 𝑙5 ∗ cos(𝜃10 )
) 0 𝑙5 ∗ sin(𝜃10 )
9
𝐴10 = [ sin(𝜃10 ) cos(𝜃10 ]
0 0 1 0
0 0 0 1
Donde:
𝑙5 : 8.605 (𝑐𝑚)
𝜃10 : 𝑞3 (°)
𝑇 = 𝐴10 ∗ 𝐴12 ∗ 𝐴23 ∗ 𝐴34 ∗ 𝐴45 ∗ 𝐴56 ∗ 𝐴67 ∗ 𝐴78 ∗ 𝐴89 ∗ 𝐴10
9
Con el bloque ¨Matlab Function¨ se obtuvo la cinemática directa de la posición del efector
final que debe tener el brazo en Simulink, por ende, se designaron entradas, salidas y el
nombre de la función (Figura 2.33).
Donde:
x, y, z: Salidas (cm).
Después se colocaron los datos de la Tabla 2.1 (𝑑𝑖 , 𝑎𝑖 , 𝛼𝑖 ) como resultado de la sección 2.2
(Figura 2.34).
27
Figura 2.34. Datos constantes de D-H.
En la (Figura 2.35) se muestra una matriz de transformación; en total son diez matrices que
se colocaron de la sección 2.2.
Con la Ecuación 2.6 se obtuvo el resultado de la matriz resultante, se calculó los valores
de posición del efector final del brazo robótico modelo Pincher X-100 (Figura 2.36).
28
Figura 2.37. Instrucción ¨guide¨.
Se desplegó una ventana nueva, donde se escogió ¨File¨ en la opción ¨New¨ (Figura 2.38).
Que a su vez abrió una ventana en donde se escogió ¨Blank GUI (Default)¨ (Figura 2.39).
29
Edit Text: Bloque que permite editar o escribir texto
30
2.4 Manual instructivo para la simulación del brazo robótico
Pincher X-100.
31
3 RESULTADOS
Para comprobar que la simulación del brazo robótico Pincher X-100 funcione, se calcula el
error relativo porcentual del efector final empleando el valor calculado y el medido.
Para comparar se asignan valores de ángulo de giro para el alcance del efector final,
equiparando las ecuaciones de cinemática directa en Simulink con las del brazo virtual
ensamblado en Autodesk Inventor.
N° de prueba
Referencias 1 2 3 4
1 22 37 -71 -25
Ángulo de giro para las articulaciones (°) 2 28 53 -111 -20
3 -100 -75 60 47
4 -35 90 -75 50
X 6.648 9.714 -3.37 -7.058
Posición del efector final calculada (cm) Y 16.46 12.89 1.16 15.14
Z 30.82 23.89 12.9 18.36
X 6.673 9.720 -3.39 -7.02
Posición del efector final medida (cm) Y 16.41 12.83 1.212 15.16
Z 31.10 24.18 13.25 18.64
X 0.375 0.062 0.59 0.541
Error relativo porcentual (%) Y 0.305 0.468 4.29 0.132
Z 0.9 1.19 2.642 1.502
A partir de la Tabla 3.1 se deduce que el porcentaje de error es bajo manteniéndose menor
al 5%, por lo que esta prueba confirma que la cinemática directa es correcta. Por tanto, la
posición del efector final coincide con la metodología de Denavit-Hartenberg.
32
Para comparar se asignan valores de ángulo de giro para el alcance del efector final,
equiparando las ecuaciones de cinemática directa en Simulink, con en el brazo virtual
exportado en Simulink.
N° de prueba
Referencias 1 2 3 4
1 10 30 60 -90
Ángulo de giro para las articulaciones (°) 2 -15 45 -100 50
3 -80 60 -130 -20
4 -30 100 75 -120
X 0.6178 7.765 -10.35 -11.12
Posición del efector final calculada (cm) Y 3.504 13.45 -5.974 0.392
Z 37.27 3.132 -4.054 3.389
X 1.214 8.615 -9.792 -10.44
Posición del efector final medida (cm) Y 3.816 13.9 -6.304 0.5729
Z 38.26 3.359 -4.358 3.251
X 49.11 9.867 5.699 6.513
Error relativo porcentual (%) Y 8.176 3.237 5.235 31.57
Z 2.58 6.758 6.976 4.245
A partir de la Tabla 3.2 se observa que el error tiende a ser grande, debido a que en la
conformación del brazo robótico existe un desfase, haciendo que los valores medidos
tiendan a aproximarse a los valores calculados.
N° de prueba
Parámetros 1 2 3 4
1 10 24 -15 -45
Ángulo de giro ingresado por medio de la interfaz 2 20 57 90 -35
(°) 3 36 88 120 20
4 -45 35 -75 100
Valor de giro medido (rad) 1 0.1741 0.4178 -0.2611 -0.7817
33
N° de prueba
Parámetros 1 2 3 4
Valor de giro medido (rad) 2 0.3482 0.9923 1.567 -0.608
3 0.6271 1.533 2.09 0.3476
4 -0.7838 0.6096 -1.306 1.738
1 9.97 23.94 -14.96 -44.79
Conversión de radianes a grados del valor de giro 2 19.95 56.85 89.78 -34.84
medido (°) 3 35.93 87.83 119.75 19.92
4 -44.91 34.93 -74.83 99.58
1 0.3 0.25 0.267 0.467
Error relativo porcentual (%) 2 0.25 0.26 0.24 0.457
3 0.19 0.19 0.21 0.4
4 0.2 0.2 0.22 0.42
A partir de la Tabla 3.3 se observa que el error de ángulo ingresado con el que se mide en
la simulación de bloques de Simulink tiende a ser mínima, por lo que, los giros se efectúan
de manera correcta y logran la posición deseada.
34
4 CONCLUSIONES
• Se estableció el modelo del brazo robótico encontrando 7 piezas en total, de lo que
se observó que tiene 4 articulaciones incluyendo las pinzas, además de que se
debió tomar en cuenta el sistema de coordenadas, ya que al descargar el plano
venía con una referencia distinta a la que se usó en la metodología de Denavit-
Hartenberg.
• Se obtuvo el modelo del brazo robótico con los planos 3D que se los puede
conseguir en páginas referentes a la robótica, donde la pieza base debe
encontrarse en el centro del plano Autodesk Inventor. Además, de que se necesita
al menos de una pinza para la posición final del efector, debido a que no se puede
dividir la pieza que contiene el efector final, por tanto, la pinza es necesaria para
saber la posición del efector.
35
• La finalidad del instructivo es que el usuario tenga una introducción a las funciones
de Simulink de Matlab, además de un acercamiento a la robótica y el uso de
programación para el desarrollo de la simulación del brazo robótico Pincher X-100.
36
5 RECOMENDACIONES
• Al momento de abrir el archivo de plano Step donde se encuentra el diseño en 3D
del brazo robótico se recomienda crear carpetas individuales, para que no exista
problemas de dirección en los archivos, además de utilizar nombres diferentes, ya
que al momento de volver a abrir el archivo (.step) con un archivo para ensamblaje
existe un error de dirección por lo que el programa Autodesk Inventor no permite
volver a dar inicio o edición al archivo de ensamblaje, y la pieza no se abrirá debido
a que comparten el mismo nombre de dirección.
• Revisar el sistema de coordenadas que viene dado por el plano descargado, ya que
de esta manera se usará herramientas de simetría en las piezas para que coincida
con nuestro sistema de coordenadas que se lo usó de referencia en la metodología
de Denavit-Hartenberg. Además de, asegurarse que las piezas tengan centro de
masa que permitan la simulación, porque existen páginas que contienen los planos
y algunos archivos no tienen centro de masa en la exportación de Autodesk Inventor
con Simulink.
• Existen planos del brazo robótico Pincher X-100 que muestran los valores de las
distancias que existe entre cada articulación del brazo, por lo que si hay la
oportunidad de buscar o utilizar la herramienta ¨medir¨ desde el centro de cada
pieza que conforma el brazo robótico. Es recomendable dividir las distancias de una
articulación a otra, en ocasiones existen dos distancias seguidas que se deben
contar para el análisis de cinemática directa usando el método de Denavit-
Hartenberg.
• Verificar las unidades que tiene cada bloque que conforma la exportación de
Autodesk Inventor a Simulink, ya que este viene dado por el programa, para evitar
errores en los valores medidos de la posición del efector final del brazo robótico.
Además de que, se debe revisar la configuración de Simulink que viene por defecto;
en la opción ¨Data¨, este tiene activado un bloque ¨out¨ que hace que todos los
bloques ¨simout¨ se agrupen en un archivo externo y no muestre los valores de la
simulación.
• Verificar en el momento de ensamblaje del brazo que la pieza tenga una posición
positiva o se encuentre de acuerdo con modelos referenciados del brazo robótico
Pincher X-100, ya que, existe la posibilidad de que la pieza se encuentre invertida
y al colocar un valor este dará un movimiento opuesto al deseado en la simulación.
37
6 REFERENCIAS BIBLIOGRÁFICAS
[1] Efector Final - Lo que su Robot necesita - DACHS-SOLUTIONS. (n.d.). Retrieved
January 24, 2023, from [Link]
[2] ¿Qué es un brazo robótico industrial? Fabricantes y precio. (n.d.). Retrieved January
24, 2023, from [Link]
industrial/
[5] Trejo.J. (2018). Diseño y construcción de un prototipo de robot con tres grados de
libertad para posicionamiento de objetos (1ª ed., p. 8). Santa Tecla: ITCA Editores.
Recuperado de: [Link]
construcci%C3%B3n-de-un-prototipo-de-robot-con-tres-grados-de-libertad-para-
[Link].
[10] V. H. Oña Ñacata, A. F. & Vimos Tixi, Operación remota y control adaptativo de un
manipulador virtual de 3 grados de libertad - Oña Ñacata, Alex Fabricio, Vimos Tixi, Victor
Hugo - [Link], Escuela Po. Quito, 2019.
38
[11] Alosnso F. & Bravo M., Diseño, construcción y control de un brazo robótico .2014.
[En línea]. Disponile en:
[Link]
[19] Cuesta, D. N., & Huerfano, J. R. (2016). Diseño y construcción de un brazo robótico
de 6 GDL. Tekhnê, 13(1), 73-82.
39
[22] PincherX 100 Robot Arm - X-Series robotic arm. (s/f). [Link].
[Link]
[23] Simscape Multibody - SimMechanics Link - MATLAB & Simulink. (n.d.). Retrieved
February 13, 2023, from
[Link]
40
7 ANEXOS
41
ANEXO I: CERTIFICADO DE ORIGINALIDAD
CERTIFICADO DE ORIGINALIDAD
De mi consideración:
Yo, CATALINA ELIZABETH ARMAS FREIRE, en calidad de Director del Trabajo de Integración
Curricular titulado MODELADO 3D EN EL ENTORNO SIMULINK DE MATLAB DEL BRAZO
ROBÓTICO asociado a la IMPLEMENTACIÓN DE CINEMÁTICA DIRECTA DE UN BRAZO
ROBÓTICO DE 3 GRADOS DE LIBERTAD. PINCHER X-100 elaborado por el estudiante
MAURICIO ALEJANDRO LANDÍVAR VIVAS de la carrera en TECNOLOGÍA EN
ELECTROMECÁNICA, certifico que he solicitado a la Biblioteca General el informe para la
revisión de originalidad del documento escrito completo, producto del Trabajo de Integración
Curricular indicado.
Es todo cuanto puedo certificar en honor a la verdad, pudiendo el interesado hacer uso del presente
documento para los trámites de titulación.
Atentamente,
_______________________________
42
43
ANEXO II: PLANOS Y ESQUEMAS
44
43
44
Diagrama de flujo de funcionamiento de la interfaz
45
ANEXO III: CÓDIGOS DE PROGRAMACIÓN
Código para el análisis de cinemática directa
T1=[cosd(alpha1) -sind(alpha1) 0 0;
sind(alpha1) cosd(alpha1) 0 0;
0 0 1 0;
0 0 0 1;]
T2=[cosd(H1) -sind(H1) 0 0;
sind(H1) cosd(H1) 0 0;
0 0 1 d1;
0 0 0 1;]
T3=[1 0 0 0;
0 cosd(alpha2) -sind(alpha2) 0;
0 sind(alpha2) cosd(alpha2) 0;
0 0 0 1;]
T4=[cosd(H2) -sind(H2) 0 0;
sind(H2) cosd(H2) 0 0;
0 0 1 0;
0 0 0 1;]
T5=[1 0 0 0;
0 cosd(alpha3) -sind(alpha3) 0;
0 sind(alpha3) cosd(alpha3) 0;
0 0 0 1;]
46
T6=[cosd(alpha4) -sind(alpha4) 0 0;
sind(alpha4) cosd(alpha4) 0 0;
0 0 1 d2;
0 0 0 1;]
T7=[1 0 0 0;
0 cosd(alpha5) -sind(alpha5) 0;
0 sind(alpha5) cosd(alpha5) 0;
0 0 0 1;]
Botón Simular
a=str2double(get(handles.art1,'String'));
t=(0:0.01:10)';
q1_s=(a/10).*t;
assignin('base','t',t);
assignin('base','q1_s',q1_s);
47
c=str2double(get(handles.art3,'String'));
t=(0:0.01:10)';
q3_s=(c/10).*t;
assignin('base','q3_s',q3_s);
q1=str2double(get(handles.art1,'String'));
q2=str2double(get(handles.art2,'String'));
q3=str2double(get(handles.art3,'String'));
q4=str2double(get(handles.art4,'String'));
T1=[cosd(alpha1) -sind(alpha1) 0 0;
sind(alpha1) cosd(alpha1) 0 0;
0 0 1 0;
0 0 0 1;]
T2=[cosd(H1) -sind(H1) 0 0;
sind(H1) cosd(H1) 0 0;
0 0 1 d1;
0 0 0 1;]
T3=[1 0 0 0;
0 cosd(alpha2) -sind(alpha2) 0;
0 sind(alpha2) cosd(alpha2) 0;
0 0 0 1;]
48
T4=[cosd(H2) -sind(H2) 0 0;
sind(H2) cosd(H2) 0 0;
0 0 1 0;
0 0 0 1;]
T5=[1 0 0 0;
0 cosd(alpha3) -sind(alpha3) 0;
0 sind(alpha3) cosd(alpha3) 0;
0 0 0 1;]
T6=[cosd(alpha4) -sind(alpha4) 0 0;
sind(alpha4) cosd(alpha4) 0 0;
0 0 1 d2;
0 0 0 1;]
T7=[1 0 0 0;
0 cosd(alpha5) -sind(alpha5) 0;
0 sind(alpha5) cosd(alpha5) 0;
0 0 0 1;]
49
%Graficar la posición Y del brazo robot
axes(handles.axes4);
t=(0:0.01:10)';
plot(t,y_cal);
hold on
plot(t,y_med);
%Graficar la posición Z del brazo robot
axes(handles.axes5);
t=(0:0.01:10)';
plot(t,z_cal);
hold on
plot(t,z_med);
Botón Reiniciar
50
ANEXO IV: PRUEBAS DE FUNCIONAMIENTO
Imágenes obtenidas de la prueba realizada entre Simulink y Autodesk Inventor.
Prueba N°1
(a) (b)
Figura AIV.1 Prueba N°1 (a) Valor obtenido en Autodesk Inventor (b) Valor obtenido en Simulink.
51
Prueba N°2
(a) (b)
Figura AIV.2 Prueba N°2 (a) Valor obtenido en Autodesk Inventor (b) Valor obtenido en Simulink.
52
Prueba N°3
(a) (b)
Figura AIV.3 Prueba N°3 (a) Valor obtenido en Autodesk Inventor (b) Valor obtenido en Simulink.
53
Prueba N°4
(a) (b)
Figura AIV.4 Prueba N°4 (a) Valor obtenido en Autodesk Inventor (b) Valor obtenido en Simulink.
54
Imágenes obtenidas del valor calculado y el valor medido para la posición del efector final del brazo robótico.
Prueba N°1
Figura AIV.5 Prueba N°1 (a) Posición x (b) Posición y (c) Posición z.
55
Prueba N°2
Figura AIV.6 Prueba N°2 (a) Posición x (b) Posición y (c) Posición z.
56
Prueba N°3
Figura AIV.7 Prueba N°3 (a) Posición x (b) Posición y (c) Posición z.
57
Prueba N°4
Figura AIV.8 Prueba N°4 (a) Posición x (b) Posición y (c) Posición z.
58
Imágenes obtenidas de los ángulos de giro ingresados y los obtenidos para cada
articulación
Prueba N°1
Figura AIV.10 Valores de giro medidos en Simulink como referencia a la prueba N°1.
Prueba N°2
59
Valores obtenidos en radianes
Figura AIV.12 Valores de giro medidos en Simulink como referencia a la prueba N°2.
Prueba N°3
60
Valores obtenidos en radianes
Figura AIV.14 Valores de giro medidos en Simulink como referencia a la prueba N°3.
Prueba N°4
61
Valores obtenidos en radianes
Figura AIV.16 Valores de giro medidos en Simulink como referencia a la prueba N°4.
62