Documentos de Académico
Documentos de Profesional
Documentos de Cultura
DECLARACIÓN
Yo, Daniel Humberto Ordóñez Oviedo, declaro que el trabajo aquí descrito es de
mi autoría; que no ha sido previamente presentado para ningún grado o calificación
profesional; y, que he consultado las referencias bibliográficas que se incluyen en
este documento.
La Escuela Politécnica Nacional, puede hacer uso de los derechos correspondientes
a este trabajo, según lo establecido por la Ley de Propiedad Intelectual, por su
Reglamento y por la normatividad institucional vigente.
CERTIFICACIÓN
Certifico que el presente trabajo fue desarrollado por Daniel Humberto Ordóñez
Oviedo bajo mi supervisión.
AGRADECIMIENTOS
Agradezco también a mis amigos, los que compartieron las aulas conmigo y
sobre todo a aquellos con los que la amistad trascendió mas allá de un salón de
clases, a todos los muchachos del voleibol con quienes he tenido muchas alegrías
y que también siempre han estado pendientes de mi graduación les digo muchas
gracias y espero seguir viéndolos siempre.
DEDICATORIA
Dedico este trabajo a Dios por darme la vida y la salud para cumplir mis metas, a
mi familia que han sido quienes han forjado la persona que soy y que han estado
presentes toda mi vida para respaldarme en todo sentido, a Raquel, quien me ha
dado su apoyo y ayuda incondicional en mi vida y en mi carrera universitaria.
Dedico especialmente este trabajo a mis dos abuelitas, Elvita, quien ya partió de
nuestro lado pero siempre estuvo al pendiente de mi formación personal y profesio-
nal, le dedico este trabajo y espero que se sienta orgullosa de mi allá en el cielo. Y
como no dedicarle a mi abuelita Enma esta meta, ella siempre ha estado junto a mi
desde pequeñito dándome cariño y apoyándome en todo lo que he querido hacer,
a ellas dos les dedico mi trabajo y les agradezco infinitamente.
CONTENIDOS
Resumen 1
Introducción 2
Objetivo General 3
Objetivos Específicos 3
Alcance 3
Justificación 4
1. GENERALIDADES 5
1.1. Generalidades de la robótica . . . . . . . . . . . . . . . . . . . . . . . . 5
1.1.1. Historia de la robótica . . . . . . . . . . . . . . . . . . . . . . . 5
1.1.2. Robot Victoriano . . . . . . . . . . . . . . . . . . . . . . . . . 6
1.1.3. Desde el siglo XX hasta el presente . . . . . . . . . . . . . . . . 7
1.2. Las leyes de la robótica . . . . . . . . . . . . . . . . . . . . . . . . . . 8
1.3. Clasificación de los robots . . . . . . . . . . . . . . . . . . . . . . . . . 8
1.3.1. Clasificación por la configuración del robot . . . . . . . . . . . . 9
1.3.2. Clasificación por el controlador . . . . . . . . . . . . . . . . . . 11
1.3.3. Clasificación por la fuente de poder . . . . . . . . . . . . . . . . 12
1.4. Robot Stanford . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 13
1.5. Prototipado rápido . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 15
1.6. Técnicas de prototipado rápido . . . . . . . . . . . . . . . . . . . . . . 15
1.6.1. Estereolitografía . . . . . . . . . . . . . . . . . . . . . . . . . . 16
1.6.2. Sinterización selectiva por láser . . . . . . . . . . . . . . . . . . 17
1.6.3. Modelado por deposición fundida . . . . . . . . . . . . . . . . . 18
1.7. fabricación de juntas mediante diferentes métodos . . . . . . . . . . . . 19
1.7.1. Fabricación de juntas mediante el método (SL) . . . . . . . . . . 19
1.7.2. Fabricación de juntas mediante el método (SLS) . . . . . . . . . 21
1.7.3. Fabricación de juntas mediante el método (FDM) . . . . . . . . . 23
1.8. Ensamblaje rígido de partes . . . . . . . . . . . . . . . . . . . . . . . . 23
vi
2. MARCO TEÓRICO 26
2.1. Movimientos de traslación . . . . . . . . . . . . . . . . . . . . . . . . . 26
2.1.1. Traslación en el plano . . . . . . . . . . . . . . . . . . . . . . . 26
2.1.2. Traslación en el espacio . . . . . . . . . . . . . . . . . . . . . . 27
2.2. Movimientos de rotación . . . . . . . . . . . . . . . . . . . . . . . . . 29
2.2.1. Rotación en el plano . . . . . . . . . . . . . . . . . . . . . . . . 29
2.2.2. Rotación en el espacio . . . . . . . . . . . . . . . . . . . . . . . 32
2.3. Movimientos compuestos . . . . . . . . . . . . . . . . . . . . . . . . . 35
2.3.1. Premultiplicación matricial . . . . . . . . . . . . . . . . . . . . 36
2.3.2. Postmultiplicación matricial . . . . . . . . . . . . . . . . . . . . 37
2.4. Dinámica del robot . . . . . . . . . . . . . . . . . . . . . . . . . . . . 38
2.4.1. Formulación de Newton-Euler (Dinámica inversa) . . . . . . . . 38
2.4.2. Sistema de coordenadas en movimiento . . . . . . . . . . . . . . 38
2.4.3. Cinemática para los eslabones . . . . . . . . . . . . . . . . . . . 39
2.4.4. Ecuaciones de movimiento . . . . . . . . . . . . . . . . . . . . 41
REFERENCIAS 137
ix
Índice de figuras
4.30.Eslabón C . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 96
4.31.Pinza . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 96
4.32.Eje cilíndrico . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 97
4.33.Alternativas Módulo 3 . . . . . . . . . . . . . . . . . . . . . . . . . . . 98
4.34.Alternativa 1 Módulo 3 . . . . . . . . . . . . . . . . . . . . . . . . . . . 98
4.35.Alternativa 2 Módulo 3 . . . . . . . . . . . . . . . . . . . . . . . . . . . 99
4.36.Alternativa 3 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 99
4.37.Robot Standford 6 GDL . . . . . . . . . . . . . . . . . . . . . . . . . . 102
4.38.Elementos a diseñarse . . . . . . . . . . . . . . . . . . . . . . . . . . 103
4.39.DCL eslabón 6 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 103
4.40.DCL eslabón 5 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 106
4.41.DCL pasador . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 108
4.42.DCL eslabón 4 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 111
4.43.DCL eje . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 113
4.44.DCL eslabón 3 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 116
4.45.DCL ejes junta prismática . . . . . . . . . . . . . . . . . . . . . . . . . 118
4.46.DCL eslabón 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 120
4.47.DCL eslabón 1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 123
5.1. Especificaciones Ultimaker Original+ . . . . . . . . . . . . . . . . . . 127
5.2. Prototipado eslabón 6 . . . . . . . . . . . . . . . . . . . . . . . . . . . 128
5.3. Prototipado eslabón 3 . . . . . . . . . . . . . . . . . . . . . . . . . . . 128
5.4. Prototipado eslabón 3, frontal . . . . . . . . . . . . . . . . . . . . . . . 128
5.5. Prototipado eslabón 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . 129
5.6. Prototipado eslabón 1 . . . . . . . . . . . . . . . . . . . . . . . . . . . 129
5.7. Prototipado de la base . . . . . . . . . . . . . . . . . . . . . . . . . . 130
5.8. Prototipado de la base . . . . . . . . . . . . . . . . . . . . . . . . . . 130
5.9. Prototipado de la junta 1 . . . . . . . . . . . . . . . . . . . . . . . . . 131
5.10.Prototipado de la junta 2 . . . . . . . . . . . . . . . . . . . . . . . . . 131
5.11.Prototipado de la junta 2, lateral . . . . . . . . . . . . . . . . . . . . . 132
5.12.Prototipado de la junta 2, superior . . . . . . . . . . . . . . . . . . . . 132
5.13.Ejes junta 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 133
5.14.Ensamblaje eslabón 2 y 3 . . . . . . . . . . . . . . . . . . . . . . . . . 133
xii
Índice de tablas
RESUMEN
INTRODUCCIÓN
Una vez que se plantea la parte teórica, se realiza el modelo matemático del
robot y se encuentran las ecuaciones cinemáticas, es decir, las ecuaciones de po-
sición del robot, a estas se las deriva y se hallan las ecuaciones dinámicas de
velocidad y aceleración, mediante la primera y segunda derivada respectivamente,
y, finalmente cuando se tienen todas las ecuaciones para cada uno de los ejes en el
espacio se ordena las mismas mediante los jacobianos de velocidad y aceleración.
Seguido del modelo matemático del robot se realiza el diseño del manipulador
Stanford de 6 GDL mediante el método del diseño concurrente de Carles Riba, se
presenta la casa de la calidad, las especificaciones técnicas, y este proyecto se lo
realiza también bajo diseño modular, en esta fase se presentan 3 módulos que se
pueden trabajar por separado y se presentan 3 soluciones para cada módulo que
posteriormente se seleccionarán mediante el método ordinal corregido de criterios
ponderados y dará como resultado el bosquejo del robot Standford de 6 GDL, des-
pués de esto se realizan los cálculos de los elementos del robot, se considera a
cada elemento como elemento aislado y se trasladan las cargas de elemento a ele-
mento de manera progresiva y así realizar el respectivo dimensionamiento de los
eslabones de la máquina.
el robot a excepción de las piezas normalizadas que en es este caso son los roda-
mientos usados para las juntas de rotación.
OBJETIVO GENERAL
OBJETIVOS ESPECÍFICOS
ALCANCE
JUSTIFICACIÓN
1. GENERALIDADES
La historia de la robótica y de los robots es bastante larga, viene desde los tiem-
pos antiguos pero el real avance e innovación viene desde el siglo XX, la historia
de la automatización tiene un pasado muy largo y data desde la antigua Grecia con
el ingeniero Hero de Alejandría quien produjo dos textos llamados Pneumatica y
Automata(Rapp, 2015) las cuales testifican de la existencia de cientos de diferentes
tipos de máquinas capaces de realizar movimientos automáticos, por supuesto que
la robótica ha avanzado de manera increíble en los siglos XX y XXI donde se incluye
robots que son capaces de ensamblar otros robots y hasta realizar movimientos de
lo seres humanos.
autores de ciencia de ficción han querido representar máquinas que fueran capaces
de reproducir los movimientos de los seres humanos, desde el mito de la antigua
Grecia de Pygmalion hasta Frankenstein y Arthur C. Clarke’s HAL 9000.
Varios otros autómatas fueron creados donde sus movimientos simulaban a cier-
tos animales o eran humanoides que eran operados por sistemas CAM simples,
pero en el siglo XVIII los autómatas fueron mucho mejor comprendidos y desarro-
llados hasta el punto que se pudieron construir mejores y complejas piezas para
estos.
tadoras en el principio y mediados del siglo XIX, sus mejores proyectos fueron el
estudio del motor analítico y diferencial. Otros como Ada Lovelace reconocieron
que en el futuro se podrían hacer sistemas computacionales que procesen imáge-
nes o que reproduzcan música.
En los años 50 George Devol diseñó el Ultimate, un brazo robótico que trans-
portaba partes de fundición en una fábrica de General Motors, el cual empezó a
trabajar en 1961. Unimation, la compañía que Devol fundó con el interprete robótico
Joseph Engelberger, fue la primera fábrica de robots en el mundo. Los robots em-
pezaron como algo curioso, incluso aparecieron en The Night Show en 1966 pero
pronto se constituyeron en otra herramienta industrial.
Las tres leyes de la robótica aparecen en el año 1942 en el relato El círculo vi-
cioso de Asimov escrito por Isaac Asimov.
Leyes de la robótica
Ley Cero: En 1985 Isaac Asimov publica un libro en el cual uno de sus robots
se ve obligado a herir a un ser humano pero por salvar al resto de la humani-
dad, de esta manera surge una nueva y definitiva ley que precede a las tres
leyes de 1942. Esta ley dice Un robot no debe dañar a un ser humano o, por
falta de acción, permitir que la humanidad sufra daños quedando así modifi-
cada la primera ley Un robot no debe dañar a un ser humano, o permitir, por
inacción, que un ser humano sufra daño, a menos que tal acción viole la ley
cero
Primera Ley: Un robot no puede causar daño a un ser humano ni por omisión
permitir que sufra daños.
Segunda Ley: Un robot debe obedecer las órdenes de los seres humanos,
excepto aquellas órdenes que vayan en contra de la primera ley.
Existen varios métodos de clasificación de los robots, aquí se hace una lista de
los métodos de agrupación más conocidos y posterior a esto se detallarán algunos
de estos métodos. (Rapp, 2015)
La lista de métodos de clasificación es la siguiente:
9
3. Método de operación
4. Tipo de control
5. Fuente de poder
6. Tamaño
8. Tipo de tecnología
Brazo Articulado: Estos robots imitan el movimiento del brazo humano, estos
usan la célula de trabajo más extensa y requiere de bastante espacio (Fig. 1.5).
Patrón continuo: Usa memorias más grandes que las de punto a punto porque
puede memorizar varias coordenadas por segundo.
Este brazo robótico fue creado en el año 1969 por el estudiante de ingeniería
mecánica Victor Scheinman en el laboratorio de inteligencia artificial de Stanford
(SAIL) (Gast, 2003). Este manipulador de 6 grados de libertad y completamente
eléctrico mecánico fue uno de los primeros robots en ser diseñado exclusivamente
por control de computadora.
Este brazo de robot como se ve en la siguiente figura (Fig. 1.9) fue uno de los
dos que se montaron en una gran mesa con interfaz de cámaras de video (vidicon)
y otras herramientas especiales. Estas facilidades fueron usadas por profesores e
investigadores a lo largo de 20 años para proyectos y con fines educativos gracias
a que este sistema fue muy bien caracterizado, confiable y gozaba de buen man-
tenimiento. Eventualmente el robot Stanford fue aumentado con robots eléctricos y
diseños nuevos de la universidad, pero el robot azul, que es casi idéntico al Stanford
todavía es usado ocasionalmente en el laboratorio de Robótica de la universidad.
(Scheinman, 1969)
1.6.1. Estereolitografía
Figura 1.10. Equipo de SLA 250 con esquema del proceso SL (Imme Ebert-Uphoff y Laliberte,
2005).
Figura 1.12. Ejemplo del proceso de software STL: a) Parte en formato STL con la orientación
original, b) Parte orientada correctamente, c) Material de soporte añadido, d) Caminos en una de las
porciones (Imme Ebert-Uphoff y Laliberte, 2005).
El pobre deslizamiento que presentó esta junta era debido a la resina atrapada
en en la cámara y a su vez presentaba dificultades en su remoción hasta el último
curado con luz UV. También, era evidente que al momento de ensamblar la junta
aparecían más grados de libertad de los deseados.
Por tanto la junta fue rediseñada varias veces siendo su diseño final el mostra-
do en la figura (Fig. 1.13), esta junta de un solo grado de libertad no presentaba
ninguna cavidad de resina encerrada, y, su fabricación toma alrededor de 6 horas.
La junta universal fue un diseño típico el cual consiste en dos componentes dife-
rentes, las dos horquillas y el eje de conexión. Una de los diseños de junta universal
21
Se usa el diseño de la junta de revolución, esta junta se fabrica con una hol-
gura entre caras circulares de 0.5 mm. Completar la fabricación de esta junta lleva
aproximadamente 5 horas.
Las juntas también pueden ser fabricadas mediante el método SLS. Para este
ejemplo el material base escogido fue la poliamida, las holguras fueron las mismas
que las escogidas en el proceso SL, pero las piezas obtenidas mediante este pro-
ceso tuvieron una mejor precisión que el proceso SL.
La junta esférica (Fig. 1.16) está diseñada para tener un giro de aproximada-
mente 90 grados y alrededor de +− 15 grados de libertad de movimiento de lado
a lado, cuando está totalmente extendida y no tiene libertad de movimiento cuando
está contraída.
Otra restricción fue minimizar el ángulo de torsión, esto se logró con la remoción
de material de los hemisferios diametrales de la esfera interior y se añade material a
la ranura interior, esto resulta en la junta esférica modificada mostrada en la Figura
1.16.
Mediante el método FDM se pueden fabricar las juntas cilíndricas (Fig. 1.17). Las
juntas cilíndricas están fabricadas básicamente por una varilla dentro de un tubo.
De manera similar a la junta prismática se debe construir esta junta en dirección
horizontal para obtener la resistencia apropiada de la junta. Para el tubo, se usa un
puenteo para suprimir el uso de material de aporte. Como la parte superior del tubo
no es plana, la forma del tubo se modifica para permitir el puenteo sin afectar las
propiedades deseadas. Para detener el desplazamiento de la junta y permitir una
rotación suave, se añade una manga de ajuste a presión en la varilla y un capuchón
de ajuste a presión en el tubo.(Imme Ebert-Uphoff y Laliberte, 2005)
Figura 1.17. a) Junta cilíndrica con partes de junta universal al final. b)Sección transversal de la junta
cilíndrica, donde se muestra la geometría que permite el puenteo. (Imme Ebert-Uphoff y Laliberte,
2005).
Figura 1.19. Mecanismo de Bennett a) Modelo CAD. b) Prototipo (Imme Ebert-Uphoff y Laliberte,
2005).
Figura 1.20. Mecanismo Ojo Ágil a) Modelo CAD. b) Prototipo (Imme Ebert-Uphoff y Laliberte, 2005).
26
2. MARCO TEÓRICO
De la figura (Fig. 2.1) se pueden obtener las ecuaciones que relacionan a los
dos sistemas de coordenadas.
x0 = x1 + ∆x (2.1)
y0 = y1 + ∆y (2.2)
De esto se tiene:
x x
0 1
y0 = T y1 (2.4)
1 1
Por lo tanto la matriz de traslación en un plano es:
1 0 ∆x
T = 0 1 ∆y (2.5)
0 0 1
Nótese los tres vectores que se representan a la traslación del sistema móvil y
la posición del punto P.
28
P~xyz = Puvw ~
~ + dxyz (2.9)
px i~x + py j~y + pz k~z = (pu i~u + pv j~v + pw k~w ) + (∆x i~x + ∆y j~y + ∆z k~z ) (2.10)
i~x = i~u
j~y = j~v
29
k~z = k~w
px = pu + ∆ x
py = pv + ∆ y (2.11)
pz = pw + ∆ z
Es necesario escribir esta ecuación de forma matricial, para lo cual se vuelve a usar
el complemento matemático al añadir la ecuación 1=1 al sistema.
p 1 0 0 ∆x pu
x
py 0 1 0 ∆y pv
= (2.12)
pz 0 0 1 ∆z pw
1 0 0 0 1 1
Para encontrar la matriz de transformación de coordenadas de traslación en el
espacio se sigue el mismo procedimiento que las coordenadas en el plano y se
llega a la siguiente matriz:
1 0 0 ∆x
0 1 0 ∆y
T = (2.13)
0 0 1 ∆z
0 0 0 1
La figura anterior (Fig. 2.3) nos será de utilidad para escribir las ecuaciones de
transformación de coordenadas, recordando que el todo es igual a la suma de las
partes.
x x
0 1
y0 = Rz,Θ1 y1 (2.17)
1 1
CosΘ1 −SenΘ1 0
Rz,Θ1 = SenΘ1 CosΘ1 0 (2.18)
0 0 1
En la siguiente figura (Fig. 2.4), se ha rotado el sistema de coordenadas móvil
un ángulo Θ, nótese que el punto P se mueve con el sistema móvil, ahora se desea
escribir las ecuaciones que relacionan el sistema de coordenadas móvil en función
del sistema de coordenadas fijo.
Figura 2.4. Sistema de coordenadas móvil en función del fijo. (Granja, 2014)
A estas ecuaciones se les añade la ecuación 1=1 para tener una matriz homogénea.
Matricialmente las ecuaciones quedan de la siguiente forma:
32
x CosΘ1 SenΘ1 0 x
1 0
y1 = −SenΘ1 CosΘ1 0 y0 (2.21)
1 0 0 1 1
De la ecuación (2.17) se pueden despejar las coordenadas del punto P respecto
al sistema de coordenadas móvil.
x1 x
0
y1 = Rz,Θ1 −1 y0 (2.22)
1 1
De manera obligatoria, la ecuación (2.19) y la (2.20) son iguales, por lo tanto se
cumple que:
CosΘ1 SenΘ1 0
Rz,Θ1 −1 = −SenΘ1 CosΘ1 0 (2.23)
0 0 1
Si se compara la ecuación (2.21) con la ecuación (2.28) se obtiene que la ecua-
ción (2.18) es igual a la matriz inversa de la ecuación (2.21).
CosΘ1 −SenΘ1 0
Rz,Θ1 = SenΘ1 CosΘ1 0
0 0 1
CosΘ1 SenΘ1 0
T
Rz,Θ1 = −SenΘ1 CosΘ1 0
0 0 1
En conclusión:
Rz,Θ1 T = Rz,Θ1 −1
Figura 2.6. Rotación del sistema móvil alrededor de x(α), y(φ), z(Θ). (Atacama, 2012)
Para facilitar la operación con las matrices de traslación (4x4) se debe hacer el
siguiente arreglo matemático:
1 0 0 0
0 Cosα −senα 0
Rx,α = (2.30)
0 senα cosα 0
0 0 0 1
Cosφ 0 senφ 0
0 1 0 0
Ry,φ = (2.31)
−senφ 0 cosφ 0
0 0 0 1
CosΘ −senΘ 0 0
senΘ CosΘ 0 0
Rz,Θ = (2.32)
0 0 1 0
0 0 0 1
Cuando al sistema móvil se le han realizado movimientos de rotación desde el
último sistema de coordenadas, en este caso se puede multiplicar las matrices en la
secuencia en la que se realizaron los movimientos, este proceso es conocido como
la postmultiplicación matricial.
Al contrario si los movimientos se realizan con referencia al sistema de coorde-
nadas fijo, la multiplicación debe ser contraria a los movimientos realizados, este
proceso se conoce como premultiplicación matricial.
Cosα −Senα 0 Cosβ 0 Senβ 1 0 0
RRP Y (γ,β,α) = Senα Cosα 0 0 1 0 0 Cosγ −Senγ (2.34)
0 0 1 −Senβ 0 Cosβ 0 Senγ Cosγ
Para mayor facilidad se presenta la ecuación final con la sustitución del Seno
con la letra (s) y del Coseno con la letra (c).
cαcβ cαsβsγ − sαcγ cαsβcγ + sαsγ
RRP Y (γ,β,α) = sαcβ sαsβsγ + cαcγ sαsβcγ − cαsγ (2.35)
−sβ cβsγ cβcγ
37
Cosα −Senα 0 Cosβ 0 Senβ 1 0 0
R(α,β,γ) = Senα Cosα 0 0 1 0 0 Cosγ −Senγ (2.37)
0 0 1 −Senβ 0 Cosβ 0 Senγ Cosγ
Para mayor facilidad se presenta la ecuación final con la sustitución del Seno
con la letra (s) y del Coseno con la letra (c).
cαcβ cαsβsγ − sαcγ cαsβcγ + sαsγ
R(α,β,γ) = sαcβ sαsβsγ + cαcγ sαsβcγ − cαsγ (2.38)
−sβ cβsγ cβcγ
38
r = r ∗ +h (2.39)
dr dr∗ dh
= + = v ∗ +vh (2.40)
dt dt dt
Donde v* es la velocidad de P respecto del sistema de coordenadas en movi-
miento y vh es la velocidad del sistema de coordenadas móvil respecto al fijo.
Si el punto P se desplaza y rota respecto al sistema en movimiento la ecuación
(2.40) se escribe de la siguiente manera:
dr∗ dh d ∗ r∗ dh
v= + =( + wxr∗) + (2.41)
dt dt dt dt
d ∗ r∗
Donde es la velocidad lineal de P respecto al sistema de coordenadas
dt
móvil y w x r* es la velocidad angular de P respecto al sistema fijo.(NBIO, 2015).
De esto se deduce la aceleración general del sistema como:
dv d2 r∗ d2 h
a= = + 2 = a ∗ +ah (2.42)
dt dt2 dt
Escribiendo la ecuación en función de la posición y velocidad se tiene:
d2 r∗ d ∗ r∗ dw d2 h
a= + 2w + ( + wx(wxr) + xr ∗ + (2.43)
dt2 dt dt dt2
d ∗ pi ∗
vi = + wi−1 xpi ∗ +vi−1 (2.44)
dt
wi = wi−1 + wi ∗
Figura 2.8. Relaciones vectoriales entre entre los sistemas de referencia de los eslabones.(NBIO,
2015)
d ∗2 p i ∗ d ∗ pi ∗
v̇i = 2
+ wi−1
˙ x + wi−1 x(wi−1 xpi ∗) + vi−1
˙ (2.45)
dt dt
˙ + w˙i ∗
ẇi = wi−1 (2.46)
La aceleración angular del sistema referencial i, respecto del sistema i-1 se con-
sigue con la ecuación (2.51) de la siguiente manera:
d ∗ wi ∗
w˙i ∗ = + wi−1 xwi ∗ (2.47)
dt
Por lo que la ecuación 2.56 queda como:
d ∗ wi ∗
ẇi = wi−1
˙ + + wi−1 xwi ∗ (2.48)
dt
41
Normalmente en los brazos están unidos los sistemas i-1 e i a esos mismo
eslabones. La velocidad del elemento i respecto al sistema de coordenadas i-1 es
qi˙∗. Si el eslabón es prismático, la velocidad será de traslación relativa a i-1 y si es
rotacional corresponderá a una velocidad relativa rotacional del elemento i respecto
del sistema i-1.
Se usa la notación de la figura anterior (Fig. 2.8) para la siguiente figura (Fig.
2.9):
Donde:
r~1 Posición del centro de masa del eslabón i desde el origen del sistema de refe-
rencia base.
s~i Posición del centro de masa del eslabón i desde el sistema de coordenadas i
d~
ri
v~i = Velocidad lineal del centro de masa del eslabón i
dt
d~
vi
a~i = Aceleración lineal del centro de masa del eslabón i
dt
Ii Matriz de inercia del eslabón i respecto de su centro de masa con respecto al
sistema de coordenadas O
fi Fuerza que ejerce el elemento i-1 al eslabón i en el sistema i-1 para soportar al
elemento i y a los elementos que se encuentran encima
d(mi v~i )
Fi = = mi a~i (2.49)
dt
d(Ii wi )
Ni = = Ii ẇi + wi x(Ii wi ) (2.50)
dt
Se hace un balance de fuerzas y pares en la figura 2.9:
Fi = fi − fi−1 (2.51)
ri − pi−1 = pi ∗ +~
si (2.53)
En este capítulo se van a revisar las ecuaciones cinemáticas del robot Stanford
de 6 grados de libertad, así como también se va a realizar el desarrollo de las ecua-
ciones dinámicas que servirán para determinar todos los parámetros del robot, este
capítulo determinará el desarrollo del diseño y del prototipado rápido del presente
proyecto.
Figura 3.1. Representación mediante símbolos del robot Stanford. (Granja, 2014)
Donde:
n Número de eslabones
46
GDL = 6
Los pasos a seguir después vienen dados según el método DHs, que se enu-
meran de la siguiente manera(Granja, 2014).
7. Se debe hacer una tabla de parámetros del robot, los parámetros son ai , di , αi , Θi .
Donde:
9. Hallar la matriz de transformación final Tn0 = A1 ...A0 la cual nos dará la posi-
ción y orientación final del brazo en orden al sistema de coordenadas de la
48
base.
Eslabón Θi di ai αi
1 Θ∗1 + 90◦ d1 0 −90◦
2 Θ∗2 + 90◦ d2 0 90◦
3 0 d∗3 0 0
4 Θ∗4 0 0 −90◦
5 Θ∗5 0 0 90◦
6 Θ∗6 d6 0 0
Nota: Cuando se representa a alguna variable con el símbolo ’*’ quiere decir que
es una variable de articulación o junta.
Luego de tener esta tabla, se procede a escribir la matriz que permitirá la trans-
formación de coordenadas entre un sistema de coordenadas con uno próximo por
el método Denavit-Hartenberg Standard.
Nota: Al final del capítulo 4 se presentará una tabla (Tabla 4.21) con las longitu-
des de los eslabones di .
CosΘi SenΘi 0 0 1 0 0 0 1 0 0 ai 1 0 0 0
SenΘi CosΘi 0 0 0 1 0 0 0 1 0 0 0 Cosαi −Senαi 0
Ai =
0 1 1 0 0 0 1 di 0 0 1 0 0 Senαi Cosαi 0
0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1
Desde esta parte se va a usar una nueva notación para facilitar la escritura de
las ecuaciones que vienen a continuación, se representará con la inicial en ma-
yúscula de la función trigonométrica empleada y con un subíndice numérico que
representará la variable articular que se desea representar, teniendo como resulta-
50
c 0 s5 0
5
s5 0 −c5 0
A5 = (3.8)
0 1 0 0
0 0 0 1
c −s6 0 0
6
s6 c6 0 0
A6 = (3.9)
0 0 1 d6
0 0 0 1
Para hallar la matriz de transformación de coordenadas total del sistema, desde
la base hasta el actuador final, se debe multiplicar todas las matrices anteriores
según la siguiente ecuación.
T60 = A1 ∗ A2 ∗ A3 ∗ A4 ∗ A5 ∗ A6 (3.10)
r r r d
11 12 13 x
r21 r22 r23 dy
0
T6 =
(3.11)
r31 r32 r33 dz
0 0 0 1
Donde:
r11 = −C6 (C5 (C1 S4 − C4 S1 S2 ) − C2 S1 S5 ) − S6 (C1 C4 + S1 S2 S4 )
r31 = C6 (S2 S5 − C2 C4 C5 ) + C2 S4 S6
r32 = C2 C6 S4 − S6 (S2 S5 − C2 C4 C5 )
52
r23 = C1 C2 C5 − S5 (S1 S4 + C1 C4 S2 )
r33 = −C5 S2 − C2 C4 S5
dz = D1 − D6 (C5 S2 + C2 C4 S5 ) − D3 S2
d(di ) d(di ) dΘ
Vi = = ∗ (3.12)
dt dΘ dt
Lo que en sentido físico resulta:
d(di )
Vi = ∗ Θ̇ (3.13)
dΘ
Donde:
53
∂(dx )
V x1 = ∗ Θ̇1 = −d3 C1 C2 Θ̇1 +d2 S1 Θ̇1 −d6 (C2 C5 C1 Θ̇1 +S5 (−C4 S2 C1 Θ̇1 −S4 S1 Θ̇1 ))
∂Θ1
(3.16)
Derivada parcial para Θ2
∂(dx )
V x2 = ∗ Θ̇2 = d3 S1 S2 Θ̇2 − d6 (−C2 C4 S5 S1 Θ̇2 − C5 S1 S2 Θ̇2 ) (3.17)
∂Θ2
∂(dx )
V x4 = ∗ Θ̇4 = −d6 S5 (C1 C4 Θ̇4 + S1 S2 S4 Θ̇4 ) (3.18)
∂Θ4
Derivada parcial para Θ5
∂(dx )
V x5 = ∗ Θ̇5 = −d6 (−C2 S1 S5 Θ̇5 + C5 Θ̇5 (−C4 S1 S2 + C1 S4 )) (3.19)
∂Θ5
54
+S1 (d2 Θ̇1 + d6 C2 (Θ̇5 + Θ̇2 C4 )S5 ) + (d3 Θ̇2 + d6 C5 (Θ̇2 + Θ̇5 C4 ))S2 + d6 S5 (Θ̇1 − Θ̇4 S2 )S4 )
(3.20)
Se procede a hallar la ecuación de la velocidad en la dirección y.
∂(dy )
V y1 = ∗ Θ̇1 = d3 S1 C2 Θ̇1 − d2 C1 Θ̇1 − d6 (C2 C5 S1 Θ̇1 + S5 (C4 S2 S1 Θ̇1 + S4 C1 Θ̇1 ))
∂Θ1
(3.22)
Derivada parcial para Θ2
∂(dy )
V y2 = ∗ Θ̇2 = d3 C1 S2 Θ̇2 − d6 (−C2 C4 S5 C1 Θ̇2 + C5 C1 S2 Θ̇2 ) (3.23)
∂Θ2
∂(dy )
V y4= ∗ Θ̇4 = −d6 S5 (S1 C4 Θ̇4 + C1 S2 S4 Θ̇4 ) (3.24)
∂Θ4
Derivada parcial para Θ5
∂(dy )
V y5 = ∗ Θ̇5 = −d6 (C2 C1 S5 Θ̇5 + C5 Θ̇5 (−C4 C1 S2 + S1 S4 )) (3.25)
∂Θ5
Una vez halladas las derivadas parciales se procede a reemplazarlas en la ecua-
ción (3.21) para hallar la velocidad en y.
Vy = −C1 (d2 Θ̇1 + d6 C2 (Θ̇5 − Θ̇2 C4 )S5 − (d3 Θ̇2 + d6 C5 (−Θ̇2 + Θ̇5 C4 ))S2
+d6 S5 (Θ̇1 + Θ̇4 S2 )S4 ) + S1 (Θ̇1 (d3 − d6 C5 )C2 − d6 (C4 Sw (Θ̇4 + Θ̇1 S2 ) + Θ̇5 C5 S4 )) (3.26)
∂(dz )
V z1 = ∗ Θ̇1 = 0 (3.28)
∂Θ1
Derivada parcial para Θ2
∂(dz )
V z2 = ∗ Θ̇2 = −d3 C2 Θ̇2 − d6 (C5 C2 Θ̇2 − C4 S5 S2 Θ̇2 ) (3.29)
∂Θ2
Derivada parcial para Θ4
∂(dz )
V z4 = ∗ Θ̇4 = d6 C2 S5 S4 Θ̇4 (3.30)
∂Θ4
Derivada parcial para Θ5
∂(dz )
V z5 = ∗ Θ̇5 = −d6 (C5 C2 C4 Θ̇5 − S5 S2 Θ̇5 ) (3.31)
∂Θ5
Una vez halladas las derivadas parciales se procede a reemplazarlas en la ecua-
ción (3.27) para hallar la velocidad en z.
d d(di )
ai = ( ∗ Θ̇) (3.33)
dΘ dΘ
d(di ) d2 (di )
ai = ∗ Θ̈ + ∗ Θ̇ (3.34)
dΘ dΘ2
Donde:
d(di ) d2 (di )
+ ∗ Θ̈5 + ∗ Θ̇5 (3.35)
dΘ5 dΘ25
Para hallar la aceleración en x se sigue la ecuación:
d(dx ) d2 (dx )
+ ∗ Θ̈5 + ∗ Θ̇5 (3.36)
dΘ5 dΘ25
Se comienza por hallar las derivadas de los términos que contienen Θ1
d(dx ) d2 (dx )
Ax1 = ∗ Θ̈1 + ∗ Θ̇1 = −d3 C1 C2 Θ̈1 + d2 S1 Θ̈1 −
dΘ1 dΘ21
d6 (C2 C5 C1 Θ̈1 + S5 (−C4 S2 C1 Θ̈1 − S4 S1 Θ̈1 ))
d(dx ) d2 (dx )
Ax2 = ∗ Θ̈2 + ∗ Θ̇2 = d3 S1 S2 Θ̈2 − d6 (−C2 C4 S5 S1 Θ̈2 − C5 S1 S2 Θ̈2 )
dΘ2 dΘ22
d(dx ) d2 (dx )
Ax4 = ∗Θ̈4 + ∗Θ̇4 = −d6 S5 (C1 C4 Θ̈4 +S1 S2 S4 Θ̈4 )−d6 S5 (C4 S1 S2 Θ̇4 −C1 S4 Θ̇4 )
dΘ4 dΘ24
(3.39)
Derivadas parciales para los términos que contienen Θ5
57
d(dx ) d2 (dx )
Ax5 = ∗ Θ̈5 + ∗ Θ̇5 = −d6 (−C2 S1 S5 Θ̈5 + C5 Θ̈5 (−C4 S1 S2 + C1 S4 ))
dΘ5 dΘ25
+d6 C2 (Θ̈5 + Θ̈2 C4 )S5 + (d3 Θ̈2 + d6 C5 (Θ̈2 + Θ̈5 C4 ))S2 + d6 S5 (Θ̈1 − Θ̈4 S2 )S4 )
d(dy ) d2 (dy )
+ ∗ Θ̈5 + ∗ Θ̇5 (3.42)
dΘ5 dΘ25
Se empieza por hallar la derivada parcial para el término Θ1
d(dy ) d2 (dy )
Ay1 = ∗ Θ̈1 + ∗ Θ̇1 = d3 S1 C2 Θ̈1 − d2 C1 Θ̈1 −
dΘ1 dΘ21
d6 (C2 C5 S1 Θ̈1 + S5 (C4 S2 S1 Θ̈1 + S4 C1 Θ̈1 ))
d(dy ) d2 (dy )
Ay2 = ∗ Θ̈2 + ∗ Θ̇2 = d3 C1 S2 Θ̈2 − d6 (−C2 C4 S5 C1 Θ̈2 + C5 C1 S2 Θ̈2 )
dΘ2 dΘ22
d(dy ) d2 (dy )
Ay4 = ∗ Θ̈4 + ∗ Θ̇4 = −d6 S5 (S1 C4 Θ̈4 +C1 S2 S4 Θ̈4 )−d6 S5 (C1 C4 S2 Θ̇4 S1 S4 Θ̇4 )
dΘ4 dΘ24
(3.45)
Se halla la derivada parcial para el término Θ5
d(dy ) d2 (dy )
Ay5 = ∗ Θ̈5 + ∗ Θ̇5 = −d6 (C2 C1 S5 Θ̈5 + C5 Θ̈5 (−C4 C1 S2 + S1 S4 ))
dΘ5 dΘ25
ay = −C1 (d2 Θ̈1 + d6 C2 (Θ̈5 − Θ̈2 C4 )S5 − (d3 Θ̈2 + d6 C5 (−Θ̈2 + Θ̈5 C4 ))S2
+d6 S5 (Θ̈1 + Θ̈4 S2 )S4 ) + S1 (Θ̈1 (d3 − d6 C5 )C2 − d6 (C4 Sw (Θ̈4 + Θ̈1 S2 ) + Θ̈5 C5 S4 ))
+C1 ((d3 (Θ̇1 + Θ̇2 ) − d6 (Θ̇1 + Θ̇2 + Θ̇5 C5 )C2 − d6 (Θ̇1 + Θ̇2 + Θ̇4 + Θ̇5 )∗
d(dz ) d2 (dz )
+ ∗ Θ̈5 + ∗ Θ̇5 (3.48)
dΘ5 dΘ25
Se empieza por encontrar la derivada parcial de los términos que contienen Θ1
d(dz ) d2 (dz )
Az1 = ∗ Θ̈1 + ∗ Θ̇1 = 0 (3.49)
dΘ1 dΘ21
Se encuentra la derivada parcial para los términos que contienen Θ2
d(dz ) d2 (dz )
Az2 = ∗ Θ̈2 + ∗ Θ̇2 = −d3 C2 Θ̈2 − d6 (C5 C2 Θ̈2 − C4 S5 S2 Θ̈2 ) + d3 S2 Θ̇2
dΘ2 dΘ22
59
d(dz ) d2 (dz )
Az4 = ∗ Θ̈4 + ∗ Θ̇4 = d6 C2 S5 S4 Θ̈4 + d6 C2 C4 S5 Θ̇4 (3.51)
dΘ4 dΘ24
Se encuentra la derivada parcial para los términos que contienen Θ5
d(dz ) d2 (dz )
Az5 = ∗ Θ̈5 + ∗ Θ̇5 = −d6 (C5 C2 C4 Θ̈5 −S5 S2 Θ̈5 )−d6 (−C2 C4 S5 Θ̇5 −C5 S2 Θ̇5 )
dΘ5 dΘ25
(3.52)
Una vez que obtenemos todas las derivadas parciales se reemplazan en la ecua-
ción (3.38) para obtener la expresión de la aceleración en z.
+d6 (Θ̇2 + Θ̇4 + Θ̇5 )C2 C4 S5 + (d3 Θ̇2 + d6 (Θ̇2 + Θ̇4 )C5 )S2 (3.53)
Después de haber obtenido las ecuaciones que gobiernan la dinámica del robot,
es necesario presentarlas de una manera más ordenada y que permita usar estas
ecuaciones de mejor manera.
V = J Θ̇ (3.54)
Donde:
V Vector velocidad en x, y, z
Θ̇1
Vx V x V x2 V x4 V x5
1 Θ̇
2
(3.55)
V y = V y1 V y2 V y4 V y5
Θ̇4
Vz V z1 V z2 V z4 V z5
Θ̇5
Además, si las entradas del robot en cuanto a la velocidad son las componentes
en x, y, z y lo que se desea encontrar son las respectivas velocidades angulares,
entonces se debe escribir la ecuación de la siguiente forma:
Θ̇ = J −1 V (3.56)
61
Θ̇1 J11 J12 J13 J14 Vx
Θ̇2 J21 J22 J23 J24 V y
= L (3.57)
Θ̇4 J31 J32 J33 J34 V z
1
Θ̇5 0 0 0 1
L
Cada elemento de la inversa del Jacobiano viene dado por las siguientes expre-
siones:
1
L =
−V x4 V y2 V z1 + V x2 V y4 V z1 + V x4 V y1 V z2 − V x1 V y4 V z2 − V x2 V y1 V z4 + V x1 V y2 V z4
J11 = −V y4 V z2 + V y2 V z4
J12 = V x4 V z2 − V x2 V z4
J13 = −V x4 V y2 + V x2 V y4
J14 = V x5 V y4 V z2 −V x4 V y5 V z2 −V x5 V y2 V z4 +V x2 V y5 V z4 +V x4 V y2 V z5 −V x2 V y4 V z5
J21 = V y4 V z1 − V y1 V z4
J22 = −V x4 V z1 + V x1 V z4
J23 = V x4 V y1 − V x1 V y4
J24 = −V x5 V y4 V z1 +V x4 V y5 V z1 +V x5 V y1 V z4 −V x1 V y5 V z4 −V x4 V y1 V z5 +V x1 V y4 V z5
J31 = −V y2 V z1 + V y1 V z2
J32 = V x2 V z1 − V x1 V z2
J33 = −V x2 V y1 + V x1 V y2
J34 = V x5 V y2 V z1 −V x2 V y5 V z1 −V x5 V y1 V z2 +V x1 V y5 V z2 +V x2 V y1 V z5 −V x1 V y2 V z5
A = J Θ̈ (3.58)
Donde:
A Vector aceleración en x, y, z
Ahora, si las entradas del robot en cuanto a la aceleración son las componentes
en x, y, z y lo que se desea encontrar son las respectivas aceleraciones angulares,
entonces se debe escribir la ecuación de la siguiente forma:
Θ̈ = J −1 A (3.60)
Θ̈1 I11 I12 I13 I14 ax
Θ̈2 I21 I22 I23 I24 ay
=K (3.61)
Θ̈4 I31 I32 I33 I34 az
1
Θ̈5 0 0 0 1
K
Cada elemento de la inversa del Jacobiano viene dado por las siguientes expre-
siones:
64
1
K =
−Ax4 Ay2 Az1 + Ax2 Ay4 Az1 + Ax4 Ay1 Az2 − Ax1 Ay4 Az2 − Ax2 Ay1 Az4 + Ax1 Ay2 Az4
I11 = −Ay4 Az2 + Ay2 Az4
I14 = Ax5 Ay4 Az2 − Ax4 Ay5 Az2 − Ax5 Ay2 Az4 + Ax2 Ay5 Az4 + Ax4 Ay2 Az5 − Ax2 Ay4 Az5
I24 = −Ax5 Ay4 Az1 +Ax4 Ay5 Az1 +Ax5 Ay1 Az4 −Ax1 Ay5 Az4 −Ax4 Ay1 Az5 +Ax1 Ay4 Az5
I34 = Ax5 Ay2 Az1 − Ax2 Ay5 Az1 − Ax5 Ay1 Az2 + Ax1 Ay5 Az2 + Ax2 Ay1 Az5 − Ax1 Ay2 Az5
Cada elemento del Jacobiano de aceleración viene dado por las siguientes ecua-
ciones:
La casa de la calidad (Fig. 4.1) es una herramienta de gran ayuda para el diseño
de cualquier máquina, debido a que esta integra la voz del usuario, que representa
a los requerimientos del cliente sobre el producto, e integra la voz del ingeniero, que
hace referencia a los requerimientos del profesional sobre el producto a diseñarse.
Forma
El usuario pide que la forma del brazo robótico sea adecuada para facilitar su
uso y movimiento.
Movimientos
Se requiere que el brazo pueda realizar todos los movimientos que el usuario
desee, es decir, que no exista posiciones únicas para el movimiento del robot.
Precio
Una de las peticiones de los usuarios que siempre se debe tomar en cuenta
es el costo del producto, por tanto, el usuario pide que el costo sea el más
bajo posible.
Ligero
Es necesario que el brazo sea ligero según los usuarios, ya que esto les per-
mitirá transportar el robot sin problemas.
67
Estética
Es muy importante para el cliente que el robot tenga una buena apariencia,
esto es una parte fundamental para que el usuario adquiera el brazo robótico.
Durable
Los usuarios manifiestan su deseo de tener un robot que dure mucho tiempo
y que su mantenimiento sea económico.
Fácil de Usar
Se desea un brazo robótico que sea fácil de operar, que no implique compli-
cadas programaciones o conocimientos específicos para poder usar el brazo.
Riesgos
Funciones
El usuario desea que el brazo pueda usarse para varias funciones, es decir
que su uso no se limite a una sola acción.
Tamaño
Se va a dar la lista de la voz del ingeniero de los requerimientos que este tiene
para el diseño del robot.
Geometría
Montaje
Grados de Libertad
Seguridad
Calidad
Mantenimiento
El profesional debe asegurar que el diseño del brazo permita un fácil mante-
nimiento del mismo.
Materiales
Operación.
Se debe considerar todos los modos de operación del brazo y elegir el más
óptimo para que el brazo funcione correctamente.
Es toda aquella determinación que, sin ser vitales para el brazo articulado, hace
que muchos de sus aspectos mejoren.
Como elemento inicial del diseño, conviene ordenar las especificaciones del ro-
bot en un documento rápido al cual se le denomina Especificaciones Técnicas el
70
ESPECIFICACIONES
Para el presente proyecto se van a definir los módulos que se necesitan para la
construcción del robot y además se organizará por niveles la modularidad, es decir,
el nivel 0 será el más básico, en este se representará la función global del brazo
robótico y en el siguiente nivel se descompondrán los módulos necesarios para su
fabricación.
ELEMENTO SÍMBOLO
Función Rectángulo de línea continua
Material Flecha de doble línea continua
Energía Flecha de línea continua
Señal Flecha de línea entrecortada
Sistema, subsistema, módulo Polígono de línea entrecortada
4.3.1. Nivel 0
Este es el nivel más básico donde representa la función global del brazo robótico
(Fig. 4.2), sus entradas, el tipo de energía que usa y la señal necesaria, así mismo
muestra el resultado final.
4.3.2. Nivel 1
Este es el nivel más desarrollado para el Robot Stanford (Fig.4.3), tiene 6 accio-
nes las cuales podrían formar 6 módulos o se puede llegar a un arreglo conveniente
para los módulos de fabricación del producto, en la siguiente figura se puede apre-
ciar la distribución del nivel 1.
4.3.3. Módulos
Este es el primer módulo del robot, aquí se van a presentar las alternativas para
la base, junta y eslabón 1 del manipulador.
Base
Para la base se encuentran las siguientes alternativas:
73
Semi-Esférica
Este modelo de base es de forma semi-esférica con alojamientos para la junta
rotatoria y para el eslabón número 1 (Fig. 4.5)
Ventajas
Desventajas
Base Cilíndrica
Este modelo tiene como referencia que tiene las dos caras paralelas circulares,
de poca altura y buena fijación. (Fig. 4.6)
Ventajas
Desventajas
Ventajas
Desventajas
Junta 1
Para la junta rotatoria número 1, se decide ubicar un rodamiento de bolas, es la
opción más sencilla, ya que es un elemento normalizado, no hace falta diseñarlo y
cumple de manera satisfactoria la función que va a desempeñar.(Fig. 4.8)
77
Eslabón1
Para el primer eslabón se presentan las siguientes alternativas
Eje con estrías
Se presenta una alternativa con un eje redondo y cambio de sección, radio de
acuerdo y dos estrías que servirán de guía para el siguiente módulo. (Fig. 4.9)
Ventajas
Desventajas
Eje Cuadrado
Esta solución se hace mediante eje cuadrado, presenta un cambio de sección y
forma. (Fig. 4.10)
Ventajas
Desventajas
La construcción es dificultosa.
Eje Redondo
Esta solución se hace mediante eje redondo, puede tener o no un cambio de
sección. (Fig. 4.11)
Ventajas
Desventajas
ALTERNATIVA 1
Como se muestra en la siguiente figura (Fig. 4.13) el boceto de la alternativa
número 1 para el módulo 1.
80
ALTERNATIVA 2
Se muestra en la siguiente figura (Fig. 4.14) el boceto de la alternativa número 2
para el módulo 1.
81
ALTERNATIVA 3
Se muestra en la siguiente figura (Fig. 4.15) el boceto de la alternativa número 3
para el módulo 1.
Los criterios con los cuales se va a escoger la alternativa adecuada para este
módulo son los siguientes:
Este es el segundo módulo del robot, aquí se van a presentar las alternativas
para junta rotatoria , junta prismática y los eslabones 2 y 3 del manipulador.
Junta rotatoria
Para la junta rotatoria se encuentran las siguientes alternativas:
Acople 1
Este modelo indica una junta abierta con alojamientos para rodamientos de igual
tamaño como se indica en la figura. (Fig. 4.16)
Ventajas
Fácil montaje.
Desventajas
85
Acople 2
Este modelo indica una junta cerrada con alojamientos para rodamientos de
distinto tamaño como se indica en la figura. (Fig. 4.17)
Ventajas
Desventajas
Eslabón 2
Para el eslabón 2 se encuentran las siguientes alternativas:
Eje con estrías y cambio de sección
Este eje presenta un cambio de sección y dos estrías en su lado más delgado
para el posterior acople como se observa en la siguiente figura. (Fig. 4.18)
86
Ventajas
Facilidad de montaje.
Desventajas
Ventajas
Más ligero.
87
Desventajas
Junta prismática
Para la junta prismática se desarrolló una única solución, que consta de una
guía para el eslabón mediante rodillos que limita los grados de libertad a uno solo.
Junta Prismática
Esta junta permite el movimiento únicamente lineal del eslabón número 3 y se
asegura el movimiento lineal mediante rodillos. (Fig. 4.20)
Ventajas
Desventajas
Eslabón 3
A continuación se presentan dos soluciones para el tercer eslabón.
Eslabón vaciado
Se usa un eslabón vaciado de sección rectangular con alojamiento para la junta
precedente como se muestra en la figura (Fig. 4.21)
Ventajas
Es más ligero.
Protege al servomotor
Desventajas
Dificultad de construcción.
Eslabón macizo
Se usa un eslabón macizo de sección rectangular con alojamiento para la junta
precedente como se muestra en la figura (Fig. 4.22)
Ventajas
Desventajas
No posee guías.
Más pesado.
ALTERNATIVA 2
Se muestra en la siguiente figura (Fig. 4.25) el boceto de la alternativa número 2
para el módulo 2.
ALTERNATIVA 3
Se muestra en la siguiente figura (Fig. 4.26) el boceto de la alternativa número 3
para el módulo 2.
91
Los criterios con los cuales se va a escoger la alternativa adecuada para este
módulo son los siguientes:
Eslabón 4
Para el eslabón 4 se encuentran las siguientes alternativas:
Eje cuadrado
Este modelo de eje es de forma cuadrada con cambio de sección orificio, para
la junta de rotación tal como se ve en la siguiente figura. (Fig. 4.27)
Ventajas
Desventajas
No es muy estético
Brazos
Esta alternativa consta de dos brazos rectangulares equidistantes del eje central.
(Fig. 4.28)
Ventajas
Es estético.
Reduce el peso.
Desventajas
Juntas de rotación
Rodamientos
Para este módulo como en en los anteriores se escoge como alternativa única
el uso de rodamientos de bolas para las juntas de rotación. (Fig. 4.8)
Eslabón 5
Eje rectangular
Como alternativa se presenta un eslabón rectangular con alojamientos para el
rodamiento y un pasador como se ve en la siguiente figura. (Fig. 4.29)
Ventajas
Facilidad de construcción.
Fácil montaje.
Desventajas
Muy pesado.
Forma C
Esta alternativa se presenta un eslabón con forma de C como se ve en la si-
guiente figura. (Fig. 4.30)
96
Ventajas
Reduce el peso.
Facilidad de movimiento.
Desventajas
Eslabón 6
Pinza
Se presenta la alternativa de una pinza para el eslabón final. (Fig. 4.31)
Ventajas
Facilidad de construcción.
Fácil montaje.
Desventajas
Eje Cilíndrico
Se presenta la alternativa de eje cilíndrico para el eslabón 6. (Fig. 4.32)
Ventajas
Facilidad de construcción.
Fácil montaje.
Desventajas
ALTERNATIVA 2
Se muestra en la siguiente figura (Fig. 4.35) el boceto de la alternativa número 2
para el módulo 3.
99
ALTERNATIVA 3
Se muestra en la siguiente figura (Fig. 4.36) el boceto de la alternativa número 3
para el módulo 3.
Los criterios con los cuales se va a escoger la alternativa adecuada para este
módulo son los siguientes:
ROBOT STANFORD
Se muestra en la siguiente figura (Fig. 4.37) el boceto de la máquina a ser dise-
ñada.
Para el cálculo de los elementos del robot se va a hacer uso de dos fuen-
tes principales de bibliografía, el libro de Diseño de elementos de Máquinas de
Shigley(Budynas G., 2012) y el libro de Mecánica de Materiales de Gere(Gere,
2010), además se van a mantener constantes los siguientes valores a lo largo de
todo el proceso de cálculo de los elementos(MakerBot, 2012).
Material: PLA
Este es el eslabón final del robot y el que va a estar en contacto con la carga, en
la siguiente figura (Fig. 4.38) se aprecia el Diagrama de Cuerpo Libre (DCL) para el
104
eslabón número 6.
El peso propio del elemento se calcula mediante la siguiente ecuación. (Ec. 4.1)
q = γA (4.1)
πd2
q = γ( )
4
Donde:
ΣM = 0
L2
M = PL + q (4.2)
2
π ∗ d 2 L2
Mmax = P L + γ( )
4 2
Donde
ΣF y = 0
105
V = P + qL (4.3)
πd3
S= (4.4)
32
Igualando momentos(Gere, 2010)
Donde
Sy
σadm = = 20M P a (4.6)
FS
Igualando ecuaciones (Ec. 4.4)(Ec. 4.5) y agrupando datos, tenemos lo siguien-
te:
32P L
σadm d3 − 4γL2 d2 − =0 (4.7)
π
Asignando una longitud L = 40mm y resolviendo la ecuación anterior (Ec. 4.7)
se obtiene el diámetro mínimo para el eslabón número 6.
d = 0,005849m
d = 6mm
r 1
= = 0,16 (4.8)
d 6
106
Con este último valor y la figura del libro de Shigley A-15-9 (Budynas G., 2012)
se halla la siguiente relación
D
= 1,5 (4.9)
d
D = 1,5d = 9mm
Para este eslabón se considera el siguiente DCL (Fig. 4.39), donde se van pa-
sando en cadena las cargas a cada elemento y poder calcular cada elemento como
si fuera un elemento individual. El peso del rodamiento es despreciable.
Donde:
Se calcula la carga P1 (Ec. 4.10) que viene de la fuerza cortante del elemento
anterior mediante la siguiente ecuación.
P1 = P + qL = 9,82N (4.10)
ΣM = 0
L2
M1 = P1 L + q1 bh + W L + M = Mmax (4.11)
2
Donde:
bh2
S= (4.12)
6
Se igualan las ecuaciones (Ec. 4.11) (Ec. 4.12) y agrupando datos se tiene:
L2 bh2
P1 L + q1 bh + W L + M = σadm (4.14)
2 6
Se reemplaza valores y resolviendo la ecuación (Ec. 4.14) se obtiene el siguiente
resultado:
h = 0,00556m
h = 6mm
108
Se calcula la fuerza cortante V1 que se usará para el cálculo del siguiente ele-
mento mediante la ecuación que sigue:
V1 = τ AL + W + P1 (4.15)
V1 = 10,84N
Ahora se va a realizar el cálculo del pasador que une al eslabón 5 con el eslabón
4, este elemento va a estar sometido a una combinación de cargas como se ve en
el DCL (Fig. 4.40). Por lo tanto se van a usar teorías de falla a carga estática para
el cálculo de las dimensiones de este elemento.
Donde:
Ra Reacción en en el apoyo A.
Rb Reacción en en el apoyo B.
ΣF y = 0
V 1 = Ra + Rb (4.16)
ΣMa = 0
L
V1 − Rb L = 0 (4.17)
2
Se resuelve la ecuación (Ec. 4.17) y se tiene el resultado de la reacción Rb luego
se reemplaza en la ecuación anterior (Ec. 4.16) y se tiene el resultado de la reacción
Ra .
Ra = 5,42N
Rb = 5,42N
Para el cálculo del momento máximo en el elemento se usa la Tabla A-9 del
apéndice A del libro de Shigley(Budynas G., 2012), con lo cual se obtiene la si-
guiente fórmula.
L
M max = V1 (4.18)
4
M max = 0,06775N m
T = M1 = 2,717N m
Ahora se hallan los esfuerzos normal y cortante(Budynas G., 2012) como sigue:
110
32M max
σx = (4.19)
πd3
16T
τxy = (4.20)
πd3
Se reemplazan valores en estas dos ecuaciones y se tiene:
0,69
σx =
d3
13,8376
τxy =
d3
Ahora se hallan los esfuerzos principales mediante las siguientes ecuaciones
(Budynas G., 2012).
r
σx + σy σx σy 2
σ1,2 = ± ( 2
) + τxy (4.21)
2 2
Si se reemplazan valores en estas ecuaciones (Ec. 4.19) (Ec. 4.20) se tiene los
dos esfuerzos principales como sigue:
r
0,345 1
σ1 = + 13,8419
d3 d6
r
0,345 1
σ2 = − 13,8419
d3 d6
Se aplica la teoría de falla del esfuerzo cortante máximo para materiales dúctiles
y se tiene lo siguiente.
σ ′ = σ1 − σ2 (4.22)
Sy
σ′ = (4.23)
FS
Sy
FS = (4.24)
σ1 − σ2
111
d = 0,0097m
d = 10mm
Para este eslabón se considera el siguiente DCL (Fig. 4.41), donde se van pa-
sando en cadena las cargas a cada elemento y poder así calcular cada eslabón
como si fuera un elemento individual. El peso del pasador es despreciable, además
se va a hacer el cálculo para uno de los brazos ya que para el otro será idéntica su
forma de calcular.
Donde:
ΣM = 0
P2 L2 W 1 M1
M3 = L + q2 bh + L+ = Mmax (4.25)
2 2 2 2
Donde:
bh2
S= (4.26)
6
Se iguala ecuaciones (Ec. 4.25) (Ec. 4.26) y se agrupa los datos para obtener lo
siguiente:
P2 L2 W 1 M1 bh2
L + q2 bh + L+ = σadm (4.28)
2 2 2 2 6
Se reemplazan valores y se resuelve la ecuación (Ec. 4.28) para obtener el si-
guiente resultado:
Mmax = M3 = 1,7N m
Con este valor y la ecuación siguiente podemos hallar el factor de seguridad con
el que estamos trabajando.
113
Sy
FS =
Mmax
FS = 9
L2
M4 = M3 + γA (4.29)
2
M4 = 3,2301N m
V4 = P3 + γAL (4.30)
V4 = 11,8266N
Ahora se presenta el cálculo del eje circular que une al eslabón 4 con el eslabón
3 y su DCL (Fig. 4.42).
Donde:
Se calcula la fuerza P4
P3 = V 3 + W 2 + q 3 L (4.31)
P3 = 11,8266N
El peso propio del elemento se calcula mediante la siguiente ecuación (Ec. 4.32).
q3 = γA (4.32)
πd2
q3 = γ( )
4
El momento máximo se da en el lugar del empotramiento y se calcula de la
siguiente manera:
ΣM = 0
π ∗ d 2 L2
Mmax = P4 L + γ( ) + M3 (4.33)
4 2
Donde
πd3
S= (4.34)
32
Se iguala momentos(Gere, 2010)
115
Donde
Sy
σadm = = 20M P a (4.36)
FS
Se igualan las ecuaciones (Ec. 4.33) (Ec. 4.36) y se agrupan datos para obtener
lo siguiente:
π ∗ d 2 L2
P3 L + γ( ) + M3 = σadm ∗ S (4.37)
4 2
Se asigna una longitud L = 10mm y se resuelve la ecuación anterior. Se obtiene
el diámetro mínimo para el eje de unión 1.
d = 0,012m
d = 12mm
V4 = 11,83N
M4 = 3,23N m
Donde:
P4 Carga resultante del elemento anterior (eje de unión) el cual fue posteriormente
calculado.
M4 Carga resultante del elemento anterior (eje de unión) el cual fue posteriormente
calculado.
ΣM = 0
L2 L
Mmax = P4 L + γA + M4 + W 3 (4.38)
2 2
Donde
A = BH − bh
Donde:
BH 3 − bh3
S= (4.39)
6H
Se usa la relación entre el momento máximo y el módulo de sección y se tiene
lo siguiente:
Donde
Sy
σadm = = 20M P a (4.41)
FS
El factor de seguridad tiene un valor de FS = 3.
L2 L
P4 L + γA + M4 + W3 = σadm ∗ S (4.42)
2 2
Se resuelve la ecuación (Ec. 4.42) para la variable h y se tiene:
h = 0,023m
118
h = 23mm
b = 0,038m
b = 38mm
M5 = 4,447N m
V5 = P4 + γAL + W3 (4.43)
V5 = 12,5N
Donde:
119
Ra Reacción en en el apoyo A.
Rb Reacción en en el apoyo B.
Para el cálculo de las reacciones se sabe que por simetría de las fuerzas el valor
de cada una de ellas será:
Ra = Rb = V5 /4 (4.44)
Ra = Rb = 3,125N
El cálculo del momento máximo para esta configuración de viga viene dado en
la Tabla A-9 del libro de Shigley (Budynas G., 2012)
V5 L
M max = (4.45)
2 4
M max = 0,0625N m
V5 L
= σadm ∗ S (4.47)
2 4
Se resuelve esta ecuación (Ec. 4.47) y se encuentra el diámetro mínimo del eje.
d = 0,00392m
d = 4mm
120
Donde:
Ra Reacción en en el apoyo A.
Rb Reacción en en el apoyo B.
L1 Longitud del claro del elemento desde el punto A hacia el B, igual a 50mm.
ΣF y = 0
P5 = R a + R b (4.48)
P5 = V 5 + W p (4.49)
121
ΣMB = 0
Ra L1 = P5 (L1 + L2 ) (4.50)
P5 − R a = R b (4.51)
Ra = 20N
Rb = −7,5N
Se realiza el análisis del punto crítico A, es decir del voladizo del elemento.
Se hallan los esfuerzos cortantes y normales del elemento:
32M max
σx = (4.52)
πd3
16T2
τxy = (4.53)
πd3
Ahora hallamos M max:
M max = P5 L2 (4.54)
Ahora se debe modificar estos esfuerzos debido al cambio de sección del ele-
mento y después de un cálculo de prueba y error, se halla el Kt para este elemento y
este es igual a 1.4, la modificación a los esfuerzos se realiza de la siguiente manera.
122
32M max
σx = Kt( ) (4.55)
πd3
16T2
τxy = Kt( ) (4.56)
πd3
Luego de esto se hallan los esfuerzos principales con las ecuaciones siguientes:
r
σx + σy σx σy 2
σ1,2 = ± ( 2
) + τxy (4.57)
2 2
Se reemplazan valores en estas ecuaciones (Ec. 4.57) y se tienen los dos es-
fuerzos principales como sigue:
r
5,34 1
σ1 = 3 + 32,1466
d d6
r
5,34 1
σ2 = 3 − 32,1466
d d6
Se aplica la teoría de falla del esfuerzo cortante máximo para materiales dúctiles
y se tiene lo siguiente.
σ ′ = σ1 − σ2 (4.58)
Sy
σ′ = (4.59)
FS
Sy
FS = (4.60)
σ1 − σ2
Se remplaza valores en esta ecuación (Ec. 4.60) y si se resuelve para el diámetro
mínimo d se tiene lo siguiente:
d = 0,0147m
d = 15mm
123
r 1
= = 0,06 (4.61)
d 15
Kt = 1,4 (4.62)
D
= 1,15 (4.63)
d
D = 1,5d = 17mm
Donde
P6 = P5 + Wr + WE2 (4.64)
P5 = 13,5N
M 6 = M 5 + P5 L (4.65)
πd3
S= (4.66)
32
Se igualan momentos(Gere, 2010)
Mmax = M5 + P5 L (4.67)
M5 + P5 L = σadm S (4.68)
Se reemplazan valores en esta ecuación (Ec. 4.68) y se tiene el valor del diáme-
tro mínimo d.
125
d = 0,014m
d = 14mm
r 1,2
= = 0,06 (4.69)
d 14
Kt = 1,5 (4.70)
D
= 1,15 (4.71)
d
d = 12mm
Con esto se llega al final de los cálculos de los elementos del robot, no se pre-
senta un cálculo de las juntas 1, 2 y de la base debido a que estas fueron sobre-
dimensionadas en base a los resultados de los eslabones precedentes a las mis-
mas.
Ahora se presenta una tabla con las dimensiones de cada uno de los eslabones,
la misma puede ser usada en la sección 3 para las ecuaciones halladas en la mis-
ma.
Eslaboni di φi
1 100mm 14mm
2 80mm 15mm
3 100mm B = 25mm, H = 40mm
4 60mm b = 6mm, h = 21mm
5 45mm b = 25mm, h = 6mm
6 40mm 6mm
Se presentan un plano de conjunto del robot y todos los planos de taller de los
elementos no normalizados en la sección de ANEXOS del presente trabajo.
127
En este capítulo se van a encontrar las imágenes del prototipado rápido del bra-
zo manipulador, el cual fue hecho mediante el proceso de modelado por deposición
fundida (FDM) descrito en el capítulo 1 del presente trabajo.
Se presenta en la siguiente figura (Fig. 5.2) el resultado del prototipado del esla-
bón 6.
128
Se presenta en las siguientes figuras (Fig. 5.3, 5.4) el resultado del prototipado
del eslabón 3.
Se presenta en la siguiente figura (Fig. 5.5) el resultado del prototipado del esla-
bón 2.
129
Se presenta en la siguiente figura (Fig. 5.6) el resultado del prototipado del esla-
bón 1.
Se presenta en las siguientes figuras (Fig. 5.7, Fig 5.8) el resultado del prototi-
pado de la Base.
130
Se presenta en las siguientes figuras (Fig. 5.10, 5.11, 5.12) el resultado del pro-
totipado de la junta 2.
Se presenta en las siguientes figuras (Fig. 5.14, Fig. 5.15) el resultado del en-
samblaje de los eslabones 2 y 3.
Se presenta en las siguientes figuras (Fig. 5.16, Fig. 5.17) el resultado del en-
samblaje de los eslabones 2, 3 y 4.
6. CONCLUSIONES Y RECOMENDACIONES
6.1. Conclusiones
El presente proyecto entrega las ecuaciones de diseño del robot, las ecua-
ciones cinemáticas, dinámicas y un primer prototipo que puede ser usado
posteriormente para implementar un modelo definitivo e incluso con control
automático para este tipo de robot.
6.2. Recomendaciones
Sería de gran interés que se continúe con la investigación del presente pro-
yecto hasta llegar a un modelo definitivo y una función específica que pueda
ser también automatizada.
REFERENCIAS
/ROBchapter11.html.
Riba et Al, C. (2002). Diseño concurrente. (ETSEIB, Ed.). UPC.
Scheinman, V. (1969). The stanford arm (H.-E. Project, Ed.). SAIL.
Shapeways. (2015). heavy duty universal joint.
urlhttp://www.shapeways.com/product/QU46AJK9Y/heavy-duty-universal-
joint.
Ultimaker. (2016). Ultimaker original+. urlhttps://ultimaker.com/en/products/ultimaker-
originalspecifications.
UNDO. (2015). Sls, sinterizado de láser.
urlhttp://www.undoprototipos.com/portfolio/sls-sinterizado-de-laser/.
Vinogadrov, O. (2000). Fundamentals of kinematic and dynamics of machines and
mechanisms (C. Press, Ed.). USA.
Won, K., J. DeLaurentis, y Mavroidis, C. (2000). Rapid prototyping of robotic sys-
tems (Robotics y mechatronics Laboratory, Eds.). The State University of New
Jersey.