Documentos de Académico
Documentos de Profesional
Documentos de Cultura
0
PROGRAMA DE INGENIERÍA MECATRÓNICA
Periodo 2018-2
A. Marco teórico
Es una ciencia o rama de la tecnología, que estudia el diseño y
construcción de máquinas capaces de desempeñar tareas
realizadas por el ser humano o que requieren del uso de
inteligencia [1].
autónomos, capaces de evolucionar en superficies muy velocidades en cada subsecuente eslabón. Para una articulación
accidentadas. de tipo prismático se tiene [7]:
Perfeccionamiento en la implementación
Figura 6. Matriz de cinemática directa con parámetros computacional de modelos matemáticos de
D-H. manipuladores.
CINEMATICA DIRECTA:
Figura 10. Gráfico ángulo vs velocidad. Figura 13. Esquemático D-H configuración
antropomórfica.
Luego se proponen dos configuraciones de robot
manipulador de 3 grados de libertad. La primera de las 2. Tabulación de los parámetros D-H de cada uno de los
configuraciones es prismática y otra antropomórfica. manipuladores.
Para los cálculos se determinan los siguientes pasos: 3. Cálculo del modelo cinemático directo de cada uno de
los manipuladores mostrados. A partir de la tabla D-H
1. Dibujar el esquemático: colocando los sistemas de se sacan las submatrices reemplazando valores
coordenadas en convención de DENAVIT- mostrados en la siguiente matriz guía:
HARTENBERG (D-H).
INFORME DE PRÁCTICA DE LABORATORIO Versión 1.0
PROGRAMA DE INGENIERÍA MECATRÓNICA
Periodo 2018-2
𝐴32 =
PRIMERA CONFIGURACION:
𝐴30 = 𝐴10 𝐴12 𝐴32
𝐴10 =
𝐴30 =
𝐴12 =
𝐴30 =
SEGUNDA CONFIGURACION:
𝐴10 =
𝐴12 =
INFORME DE PRÁCTICA DE LABORATORIO Versión 1.0
PROGRAMA DE INGENIERÍA MECATRÓNICA
Periodo 2018-2
𝑌𝑒 − 𝑙3 cos(𝛼) = 𝑊𝑦
𝜋
Figura 15.Código de simulación para cinemática directa. 𝑊𝑦 = 𝑌𝑒 − 𝑙3 cos (𝜙 − )
2
𝜋
𝑊𝑥 = 𝑋𝑒 + 𝑙3 𝑠𝑒𝑛 (𝜙 − )
En el código se inicializan las variables que se van a utilizar, 2
luego se colocan las submatrices correspondientes a los grados
de libertad que tiene el manipulador para sacar la matriz Para θ2
principal mediante la multiplicación de estas. Para poder
obtener valores en estas matrices se coloca la tabla D-H en 𝑑 2 = 𝑙12 + 𝑙22 − 2 𝑙1 𝑙2 cos(𝜋 − 𝜃2)
donde se adquieren los valores de los tetas a partir de los sliders. 𝑑 2 = 𝑙12 + 𝑙22 + 2 𝑙1 𝑙2 cos(𝜃2)
Esto con el objetivo de lograr mover el manipulador mostrado
en la interfaz con sus correspondientes valores de teta. 𝑑 2 − 𝑙12 − 𝑙22
cos(𝜃2) =
2 𝑙1 𝑙2
Para verificar que la simulación esté funcionando
correctamente, se hace la comparación con la plataforma
RoboAnalyzer, comprobando que sí. Como 𝑑 2 = 𝑊𝑥 2 + 𝑊𝑦 2
𝑊𝑥 2 + 𝑊𝑦 2 − 𝑙12 − 𝑙22
cos(𝜃2) =
2 𝑙1 𝑙2
+
𝑠𝑒𝑛(𝜃2) = −√1 − 𝑐𝑜𝑠 2 (𝜃2)
𝜃2 = 𝑎𝑡𝑎𝑛2(𝑠𝑒𝑛(𝜃2), cos(𝜃2))
Para θ3
𝜙 = 𝜃1 + 𝜃2 + 𝜃3
𝜃3 = 𝜙 − 𝜃1 − 𝜃2
Para θ2
𝛽 = 𝑎𝑡𝑎𝑛2(𝑍𝑒 − 𝑑1, 𝑋𝑒 2 + 𝑌𝑒 2 )
𝜃1 = 𝑎𝑡𝑎𝑛2(𝑌𝑒, 𝑋𝑒)
Para θ3
𝑋𝑒 ′2 = 𝑋𝑒 2 + 𝑌𝑒 2
𝑑 2 = 𝑋𝑒 ′2 + (𝑍𝑒 − 𝑑1)2
𝑑 2 = (𝑋𝑒 2 + 𝑌𝑒 2 ) + (𝑍𝑒 − 𝑑1)2
Manipulador simulado:
Figura 28. Vectores P. Como resultado se ven las graficas de cada uno de los ángulos
tetas vs iteraciones, la trayectoria que el brazo recorre y los
Siendo Jp, jacobiano de posición, y Jo, jacobiano de puntos finales a partir de las iteraciones. A su vez, se observa el
orientación: movimiento del brazo en simulación de acuerdo a los valores
propuestos por el usuario.
Figura 29. Jacobiano de posición. Como último paso, a partir del desarrollo de los anteriores
laboratorios, se comprueba el correcto funcionamiento,
conectando el Bioloid al computador, realizando pruebas con
diferentes trayectorias.
ROBOT MITSUBICHI
Figura 31. Jacobiano total del manipulador antroporfomico. Como extra en el laboratorio, se desea hallar la tabla D-H de un
Robot Mitsubishi:
Con el jacobiano ya se puede implementar el control de
velocidad del Bioloid, que consiste en colocar una posición
inicial y otra final, la velocidad a la que se quiere que se mueva
y el numero de iteraciones, mostrando las iteraciones de cada
uno de los ángulos y una grafica donde se muestre la trayectoria
de este movimiento.
V. REFERENCIAS
Figura 35. Esquemático robot Mitsubishi. [1] UNSAC, «Robótica,» Marzo 2017. [En línea].
Available: https://robotica.wordpress.com/about/.
[Último acceso: 12 Septiembre 2018].
[2] P. J. Sanz, «Introducción a la robótica inteligente,»
PJSV, 2006.
[3] EcuRed, Septiembre 2018. [En línea]. Available:
https://www.ecured.cu/Rob%C3%B3tica. [Último
acceso: 12 Septiembre 2018].
[4] RoboRAVE IBERICA, 2017. [En línea]. Available:
Figura 36. Tabla D-H Mitsubishi. http://roboraveiberica.org/actividad/circuito-6-manejo-
de-brazos-roboticos-y-mental-g/. [Último acceso: 12
Septiembre 2018].
IV. CONCLUSIONES
[5] T. Macchiavello, «monografias,» Diciembre 2016. [En
línea]. Available:
• A partir de un buen análisis matemático en la cinemática, https://www.monografias.com/trabajos31/robotica/robot
teniendo en cuenta las dimensiones físicas y las capacidades de ica.shtml. [Último acceso: 12 Septiembre 2018].
los manipuladores, es posible implementar un software del
[6] A. J. Botero, «Cinemática de manipuladores robóticos,»
modelo detallado con el objetivo de simular el comportamiento
2015.
de cada una de las configuraciones.
[7] UMNG, «Generación de trayectorias en el espacio de
• Durante la realización de la práctica se pudo evidenciar la trabajo de un manipulador,» UMNG, Bogotá, 2015.
necesidad de rediseñar repetidamente el CAD, ya que se tuvo
problemas al implementar la pieza completa a la interfaz de
Matlab.