Академический Документы
Профессиональный Документы
Культура Документы
DIRECTOR:
ING. GRANJA RAMIREZ MARIO GERMAN MSc
mario.granja@epn.edu.ec
DECLARACIN
CERTIFICACIN
Certifico que el presente trabajo fue desarrollado por el seor Chang Herrera
Andrs Nikolas, bajo mi supervisin.
DIRECTOR DE PROYECTO
III
AGRADECIMIENTOS
DEDICATORIA
Te dedico el resultado del esfuerzo que has puesto en mi todos estos aos, desde
el da que sabias que iba a nacer, hasta el da que podamos ver fin del mundo.
A todos los que siempre creyeron en m y que me dieron la mano para seguir
adelante sin miedo a fracasar.
V
NDICE GENERAL
1. GENERALIDADES .......................................................................................... 1
NDICE DE FIGURAS
Figura 1-1 Robot paralelo planar. a) Esquema 3D, b) Espacio de trabajo (Liu, 1992)
............................................................................................................................... 9
Figura 1-2 Robot planar 3RRR ............................................................................. 10
Figura 1-3 Plataforma Stewart.............................................................................. 10
Figura 1-4 Estructura robot delta traslacional ....................................................... 11
Figura 1-5 Esquema del Robot H4 ....................................................................... 11
Figura 1-6 Robot Adept Quatro ............................................................................ 12
Figura 1-7 Robot paralelo de 5 barras con 6 GDL ................................................ 12
Figura 1-8 Espacio de Trabajo de robots seriales ................................................ 13
Figura 1-9 Espacio de Trabajo de robots paralelos (Pierrot F, y otros, 2003) ...... 14
Figura 2-1 Cadenas cinemticas .......................................................................... 19
Figura 2-2 Esquemas, nombres y smbolos de pares cinemticos ...................... 20
Figura 2-3 Cinemtica directa e inversa ............................................................... 22
Figura 2-4 Esquema de un robot articular ............................................................ 24
Figura 2-5 Configuracin Singular [1] del Sistema Articular ................................. 25
Figura 2-6 Configuracin Singular [2] del Sistema Articular ................................. 26
Figura 2-7 Posicin en el espacio ........................................................................ 27
Figura 2-8 Posicin y orientacin en el espacio. .................................................. 28
Figura 2-9 Parmetros D-H para un eslabn........................................................ 32
Figura 2-10 Establecimiento de Parmetros D-H .... Error! Marcador no definido.
Figura 2-11 Representacin coordenadas cartesianas ........................................ 36
Figura 2-12 Par de revolucin R........................................................................... 39
Figura 2-13 Par Cilndrico C ................................................................................. 40
Figura 2-14 Par prismtico P ................................................................................ 41
Figura 2-15 Par esfrico E.................................................................................... 42
Figura 2-16 Par helicoidal..................................................................................... 43
Figura 2-17 Matriz Jacobiana directa e Inversa.................................................... 44
Figura 3-1. Top 5 modelos Enthuiast 2016........................................................... 55
Figura 3-2 Top 5 modelos Plug n Play 2016 ...................................................... 56
Figura 3-3 Top 5 modelos Budget 2016 .............................................................. 56
Figura 3-4. Top 5 modelos Kit/DIY 2016 ............................................................. 57
XI
NDICE DE TABLAS
RESUMEN
ABSTRACT
Within this work, the system modeling could be found with all the equations
of position, velocity and acceleration based in the generalized coordinates principle,
LaGrange-Euler principle and the Virtual Work principle.
In the same way the dynamic modeling could be found based in the energy
principle and from an analog configuration of the system in order to determine the
principal variables and to find the matrix equation that rule the systems dynamic
behavior.
The design process in this project begins with the study of the market of the
3D printing systems, as well as the analysis of the market tendencies in order to
determine the system requirement and to configure one system based in closed
kinematic chains of 4 degrees of freedom.
Beginning from the design and the dimensioning of its elements in order to
accomplish the stablished requirements, the simulation of the system was made
from the equilibrium equations found in the modelling chapter and to corroborate the
veracity of the presented models, and to stablish a method to evaluate the most
important system points and articular variables.
Finally, the needed costs to build the designed system are determinate with
the objective of verify the system feasibility against other similar systems in
characteristics.
PRESENTACIN
CAPTULO I
1. GENERALIDADES
1.1 ROBTICA
1.2 ROBOTS
Los robots presentan una serie de caractersticas interesantes para su comprensin
y desarrollo dentro del campo investigativo, los robots ms utilizados en la
ingeniera son los robots industriales.
Existen varias definiciones aceptadas a nivel mundial debido a las diferencias entre
cada mercado manufacturero, estas definiciones se muestran a continuacin:
Los robots industriales principalmente cuentan con mecanismos que les permiten
realizar las tareas para las que fueron diseados. Sin embargo, todos los robots
cuentan con elementos que acompaan a su funcionamiento bsico, los cuales son:
Son dispositivos electrnicos que captar las interacciones del sistema con el medio
exterior, siendo esta una condicin para que el sistema trabaje en su entorno con
facilidad. Los sensores se pueden clasificar en:
Directos / Indirectos
Activos (generadores) / Pasivos (Moduladores)
Resistivos, capacitivos, inductivos
Termo-elctricos, piezo-elctricos, foto-elctricos
Locales / remotos
Con/sin contacto
Continuos / discretos
Analgicos / Digitales
6
Control de Dinmico: Se realiza un control especfico sobre los motores del robot,
considerando las propiedades dinmicas del manipulador a controlar.
Los robots paralelos se los definen como: Aquellos robots en los que el extremo
final est unido a una base por ms de una cadena cinemtica independiente
9
(Moreno, 2012) siendo esta la principal diferencia de estos con los robots serie o
brazos robticos. A continuacin, se muestra la Tabla 1-1 enfrentando los robots
en serie y los paralelos.
Figura 1-1 Robot paralelo planar. a) Esquema 3D, b) Espacio de trabajo (Liu, 1992)
10
Por otro lado, se tiene el sistema planar conocido como 3RR (Tsai, 1999), el cual
est constituido por 3 brazos conectados a 3 articulaciones rotacionales; Este robot
cuenta con 3 GDL, una rotacin y dos traslaciones. Este mecanismo se presenta
en la siguiente figura.
Una variante de este sistema fue investigada por (Tsai, 1999), que reemplazaba
con articulaciones rotatorias a las esfricas, sin embargo, el desarrollo establecido
para el robot H4 (Pierrot F, y otros, 2003), el cual mediante un brazo extra adiciona
un GDL rotacional al sistema bsico de 3GDL, este fue el sistema innovador para
aplicaciones industriales.
Por ltimo, existen varios diseos que aprovecha ventajas de sistemas bsicos,
como el desarrollado por Stocco y Salcudean, los cuales establecieron una
configuracin de un mecanismo paralelo dotado con 6 GDL partiendo del diseo
bsico del mecanismo de 5 barras (Stocco, Salcudean., 2000). El sistema se
muestra en la Figura 1-7.
El espacio de trabajo, es el espacio dentro del cual el extremo del sistema robtico
se desplaza, sin tomar en cuenta el efector final. Por lo tanto, los robots de cadena
cinemtica abierta tienen espacios de trabajos continuos sin desacoplamientos 3D;
por otro lado, los sistemas basados en cadenas cinemticas continuas se dividen
en sistemas con orientacin constante con todas las posibles posiciones en 3D o
con una posicin constante y todas las posibles orientaciones 3D.
Por otro lado, en la Figura 1-9 se puede apreciar el espacio de trabajo de robots
con cadena cinemtica cerrada.
6 Imagen tomada de: (R.C. Gonzalez; K.S. Fu; C.S.G Lee;, 1987)
14
1.3.3 APLICACIONES
Vale recalcar cierto modelo con micro manipuladores desarrollado por MEL en
Japn que permite un rango de trabajo del orden de los nanmetros. Por lo tanto,
a continuacin, se presenta una serie de aplicaciones de los robots paralelos
(Moreno, 2012):
Educacin: Maquetas y mesas de trabajo como la Deltalab EX 800 con 6 GDL que
permite el estudio del comportamiento de mecanismos complejos empleados en
aviones, motores, maquinaria y la industria cinematogrfica.
1.4 IMPRESIN 3D
Actualmente existen varios tipos de impresin 3D, sin embargo, estos se los puede
clasificar dentro de los siguientes grupos:
CAPTULO II
2. MARCO TERICO
2.1 INTRODUCCIN
Los eslabones se representan con lneas continuas con una geometra capaz de
representar satisfactoriamente su configuracin. Sin embargo, los pares
cinemticos, restringen los movimientos del sistema a un nmero determinado de
GDL para cada articulacin. El nmero de GDL que permite cada tipo de
articulacin se muestra en la Figura 2-2.
Grado de libertad, define cada uno de los movimientos independientes que puede
realizar un eslabn i respecto a su inmediato anterior i-1. El nmero de GDL dota
al sistema de mayor flexibilidad para su efector final.
!"# = 6 $ (% & 1) & 5'* & ++4', & +3'- & +2'. & + '/ + (2-1)
Donde:
n = nmero de eslabones del sistema
'0 = nmero de pares cinemticos con movilidad i
La cinemtica inversa consiste en determinar los valores que deben adoptar las
coordenadas articulares de la cadena cinemtica 7 = [7* 8 7, 8 8 79 ]: para que su
efector final se posicione y oriente en una determinada posicin espacial.
Existen varios mtodos para hallar los valores que deben adoptar las variables
articulares del sistema estudiado, con el objetivo de posicionar y orientar al sistema
en una posicin espacial especfica.
B+ = +1C C C %+(+!"#)
Donde:
Este mtodo es el adecuado cuando se requiere resolver sistemas con pocos GDL
o casos en los que se considere solo los primeros GDL del sistema.
24
Se puede constatar que el sistema tiene estructura planar, la cual es definida por el
ngulo de giro, q1 que es una variable articular, por lo que se puede obtener:
7* = DEFGH+ I M
JK
JL
(2-3)
7- = DEFGH+ T W+
U*VSN2
SN
(2-4)
7, = X & Y (2-5)
X = DEFGH I M = DEFGH+ ^ `
ZR ZR
\ _N2< P+N2>
(2-6)
#- sen+(Dcos+(SN))+
Y = DEFGH+ T W
#, P + #- $ SN
Lo que lleva a los dos posibles valores que puede tener q2 dependiendo del signo
de la raz. De esta forma las ecuaciones (2-7), (2-4) y (2-3) resuelven el problema
cinemtico inverso para el sistema utilizado como ejemplo.
27
Este mtodo parte del hecho de que se puede obtener el modelo inverso a partir
del directo, si es aplicable. En otras palabras, al conocer las relaciones de posicin
y orientacin en funcin de sus variables articulares, es posible obtener las
relaciones inversas a travs de la manipulacin de las relaciones obtenidas.
NO
l N
k = m Qp
NR
(2-8)
Donde px, py, pz representan las coordenadas del punto extremo del vector AP; para
el anlisis espacial de los robots, es comn el uso de los desarrollos de Craig
(1986). Los cuales muestran que la orientacin de un cuerpo se escribe mediante
el sistema de coordenadas {B} (Figura 2-8) solidario al cuerpo. Si se desea
representar la orientacin con respecto al sistema de coordenadas {A} (OLLERO
A., 2001, pg. 46).
l tu
kO = + rktuO P + lktuOvwxr (2-9)
l tu
kQ = + rktuQ P + lktuQvwxr (2-10)
l tu
kR = + rktuR P + lktuRvwxr (2-11)
l tu +l tu
kO 8 kQ 8 lktuR son las coordenadas del punto P, respecto al sistema de referencia
[A]. Esta expresin se la puede interpretar mediante operadores. Por lo tanto, el
operador del vector P para el sistema de coordenadas mvil [B] respecto al sistema
de referencia [A] se expresa de la siguiente manera (Craig Jhon., 2005):
1 | | ~O
| 1 | ~Q
yZ8{l} + = ++ z
| | 1 ~R
(2-12)
| | | 1
BO B BO ' BO
q+ = 'Q B 'Q ' 'Q
O B R ' R
(2-13)
1 | |
qGDFB%+DE~~E+~+< = + q(O8@) + = ++ m| F @ &% @p
| % @ F @
(2-14)
F+ | %+
qGDFB%+DE~~E+~+> = + q(Q8) + = ++ m | 1 | p
&%+ | F+
(2-15)
F+ &%+ |
qGDFB%+DE~~E+~+? = + q(R8) + = ++ m%+ F+ |p
| | 1
(2-16)
1 ++++|+++ ++++++++++|++++++ +|
| F @ &%+ @ |
q(O8@) + = ++
| ++%+ @ F @ |
(2-18)
| | | 1
F+ ++| %++ |
| 1 | |
q(Q8) + = ++ z
&%++ ++ | F+ |
(2-19)
| | | 1
c & sen | |
sen +++cos | |
q(8) + = ++ z
| ++ | 1 |
(2-20)
| | | 1
cos * = F*
sen * = *
Los robots pueden ser considerados como cadenas cinemticas que cuenta con
eslabones y pares cinemticos; El sistema de referencia fijo se lo posiciona en la
31
base del robot a partir del cual se caracterizarn los diferentes elementos de la
geometra del sistema.
Este innovador sistema, establece la localizacin que debera tomar cada sistema
de coordenadas [Si], que se encuentre ligado a un eslabn i de una cadena
articulada para poder sistematizar de manera sencilla la obtencin de las diferentes
ecuaciones cinemticas que conforman la cadena completa. (BARRIENTOS A.,
2007, pgs. 124-125)
0V*
0 +
c 0 & s 0 | | 1 | | | 1 | | D0 1 +++|+ ++++++|+++ |
s +++c 0 | | C z| 1 | | C z| 1 | | | c @0 & s @0 |
= ++ z 0 Cz
| ++ | 1 | | | 1 ~0 | | 1 | | s @0 c @0 |
| | | 1 | | | 1 | | | 1 | | | 1
c 0 & c @0 $ s 0 ++++s @0 $ s 0 D0 c 0
+++c @0 $ c 0 &s @0 $ c 0 D0 s 0
0V*
0 + = ++ zs 0
| ++ s @0 c @0 ~0
(2-23)13
| | | 1
DH1.Numerar los eslabones comenzando con 1 (primer eslabn mvil dela cadena)
y acabando con n (ltimo eslabn mvil). Se numerar como eslabn 0 a la base
fija del robot.
DH5.Situar el origen del sistema de la base (S0) en cualquier punto del eje Z0. Los
ejes X0 e Y0 se situarn de modo que formen un sistema dextrgiro con Z0.
DH9.Situar el sistema (Sn) en el extremo del robot de modo que Zn coincida con la
direccin de Zn-1 y Xn sea normal a Zn-1 y Zn.
DH10.Obtener i como el ngulo que hay que girar en torno a Zi-1 para que Xi-1 y
Xi queden paralelos.
DH13.Obtener ai como el ngulo que habra que girar en torno a Xi (que ahora
coincidira con Xi-1), para que el nuevo (Si-1) coincidiese totalmente con (Si).
Una vez realizado este procedimiento, se aplica la ecuacin 2-21 para cada uno de
los sub-sistemas de la cadena cinemtica permitiendo as obtener una expresin
matemtica que involucra las variables articulares del sistema solicitado y que de
la misma forma permite establecer cules son las variables ms relevantes del
sistema.
Una gran ventaja de este tipo de modelacin es el hecho de que las variables que
se manejan son directamente aplicables al anlisis dinmico del sistema.
La lnea que une los sistemas de coordenadas espaciales Oo-Oi nos permite
conocer las coordenadas del cuerpo i respecto al sistema de coordenadas fijo, las
cuales son:
3 coordenadas cartesianas
3 ngulos de Euler
Una ecuacin de restriccin es una ecuacin escalar que refleja las principales
caractersticas geomtricas del sistema mecnico y su configuracin de estudio.
38
Estas dependen de las coordenadas generalizadas y son tiles para determinar las
velocidades y aceleraciones a las que est sometido el cuerpo.
Las restricciones de unin definen las relaciones geomtricas del mecanismo que
se desea modelar, el cual tendr n coordenadas generalizadas para su estudio
del cual se deber generar m ecuaciones de restriccin para establecer el grado
de movilidad del sistema (F). Esto se define como:
; =%& (2-29)
Por lo tanto, cada ecuacin de restriccin que se determine ser funcin de las
uniones y de las restricciones geomtricas del sistema mecnico y ser igual a cero.
En los sistemas mecnicos existen una tendencia comn a minimizar los tipos de
pares cinemticos utilizados para representar los mecanismos, estos tienen sus
diferencias marcadas y permiten un tipo de anlisis cinemtico dependiendo de su
configuracin geomtrica y restringido por sus caractersticas constructivas. Las
ms comunes son par de revolucin, par cilndrico, par prismtico, par esfrico y el
par helicoidal.
q0 $ 0
tu < q $
tu = |
(2-32)
El par cilndrico por otro lado presenta una compatibilidad en la direccin de los ejes
de rotacin, adems tiene 2 puntos sobre el eje del par los cuales pertenecen a un
cuerpo el cual debe estar alineado con el eje comn de giro. En la Figura 2-12 se
puede apreciar los elementos del par cilndrico.
q0 $ 0
tu < q $
tu = |
(2-33)
EuZZ + C +
tttu = | (2-34)
El par prismtico se caracteriza por tener un ngulo constante entre los vectores
que definen a los eslabones y al mismo tiempo, como el modelo cilndrico, tiene 2
puntos sobre el eje del par los cuales pertenecen a un cuerpo que debe estar
alineado con el eje comn de giro. En la Figura 2-13 se puede apreciar las
caractersticas del sistema.
Al tener el mismo modelo cilndrico, este comparte las ecuaciones 2-33 y 34. Por
otro lado, la condicin de ngulo constante genera una ecuacin de unin como se
muestra en la ecuacin 2-35.
pero no comparte ningn vector de giro. En la Figura 2-14 se puede apreciar las
caractersticas del sistema.
Esta junta comparte el mismo principio que la junta de revolucin por lo que la
ecuacin de unin caracterstica corresponde a la ecuacin 2-31 del par prismtico.
Por lo tanto, est junta restringe 3 GDL al sistema.
EuZZ + = %C NC 0 (2-36)
Donde:
La matriz Jacobiana Directa nos permite conocer las velocidades del extremo del
robot, respecto a las velocidades de cada articulacin, mientras que la Inversa
acta de la misma forma que la cinemtica inversa, permitiendo conocer las
velocidades articulares necesarias para una determinada velocidad en el extremo.
Se supone, que para este desarrollo ya son conocidas las ecuaciones que
resuelven el problema cinemtico directo de un sistema de n GDL:
< = + 9* +7 > = + 9* +7 ? = + 9* +7
L K
= + 9* +7 X = + 9* +7 A = + 9* +7
(2-39)
< 7
>
1
C +
L L
+
? C
Con S = z C C
+ + + = S+C + C + +
CC
X C
(2-40)
7
A %
7 1 <
C
>
+
C V* ?
C + = + S + + ++
C
X
(2-41)
7 % A
Puede existir un caso en que la matriz J no sea cuadrada lo que indica que el
nmero de GDL es inferior al requerido, generando que haya ms filas que
columnas, sin embargo, existen ciertas condiciones que se pueden obviar y hacer
de la matriz Jacobiana una matriz cuadrada. Si por otro lado hay ms columnas
que filas, se debe a que existen redundancias en los GDL y que uno de estos puede
ser considerado como cero o como valor constante.
7* = + * (<8 >8 ?8 8 X8 A)
(2-42)
79 = + 9 (<8 >8 ?8 8 X8 A)
7 1 <
C
>
+
+
C V* ?
C
O
C
C + = + S + + + Con S = z
+
CC
C
X
(2-43)
7 %
O
A
Esto implica que un incremento infinitesimal en las coordenadas del extremo final,
supondra un incremente infinito de las articulares. En otras palabras, se obligara
a los actuadores a imprimir velocidades inabordables para los mismos.
El objetivo del control dinmico del robot es mantener la respuesta dinmica del
mismo de acuerdo a los parmetros del sistema o a determinadas metas. El
rendimiento dinmico de un robot es directamente dependiente de la eficacia de los
algoritmos de control y de su modelado dinmico.
El modelo dinmico de un robot se puede obtener a partir de leyes fsicas como las
de la mecnica newtoniana, lagrangiana, euleriana, etc, en base a parmetros
geomtricos e inerciales de los elementos. Algunas formulaciones como la de
Lagrange-Euler (L-E), Newton-Euler (N-E), Gibbs-Appell (G-A) son equivalentes
para la descripcin dinmica del robot fsico. Cada una de las formulaciones tiene
sus caractersticas y objetivos determinados haciendo de su aplicacin una eleccin
de lo que se requiera obtener como un control ms sencillo o un clculo ms rpido
(R.C. Gonzalez; K.S. Fu; C.S.G Lee;, 1987, pgs. 85-92).
1. La ubicacin del extremo del robot, en base a sus variables articulares o por
coordenadas cartesianas, sus velocidades y aceleraciones.
2. Las fuerzas y torques aplicados en sus pares cinemticos (o en su efector
final)
49
3. Los parmetros fsicos con sus respectivas magnitudes del robot como la
longitud, masa o inercia de sus elementos.
Esto hace, que la obtencin del modelo dinmico sea uno de los aspectos ms
complejos de la robtica. Sin embargo, este brinda varios beneficios en los
siguientes aspectos:
; = y = P <() (2-44)
50
Del mismo modo que el modelado cinemtico, para el dinmico se puede tener un
planteamiento de equilibrio de fuerzas y pares que intervienen en el robot, con sus
parmetros fsicos para determinar el modelo de manera directa o inversa.
(BARRIENTOS A., 2007, pg. 133)
Para sistemas de varios GDL, se considera las fuerzas de inercia, gravedad, las
fueras de Coriolis debidas al movimiento relativo, as como tambin las fuerzas
centrpetas que dependen de la configuracin del sistema en un instante dado.
&+ = ++
a a
(2-45)
# = + & + (2-46)
Donde:
7 : Coordenadas articulares
: Vector de fuerzas y pares aplicados en las 7
#: Funcin Lagrangiana
: Energa cintica
Energa potencial
Este principio plantea que, Para una deformacin virtual infinitamente pequea de
un cuerpo que se encuentra en equilibrio, el trabajo virtual de las fuerzas exteriores
51
(Mata V, 2015)
52
CAPTULO III
Durante cientos de aos los diseadores han plasmado sus ideas en planos
bidimensionales debido a las limitadas herramientas con las que contaban y
limitados por los procesos de fabricacin limitando sus prototipos a estos procesos
que no permitan obtener complejas geometras. Este hecho limitaba la distribucin
de sus proyectos, dado que no todas las personas contaban con un conocimiento
de la lectura de estas ideas en dos dimensiones.
desarrollo desde la dcada de los 90, hasta llegar al momento de mostrar modelos
en vistas explosionadas y anlisis de movimientos y fuerzas aplicadas.
Existieron por tanto muchas tcnicas de prototipado rpido durante el anterior siglo,
pero debido a su principio de funcionamiento y proceso de obtencin de piezas, lo
hace muy costoso, y adems lleva un tiempo considerable obtener la pieza
buscada, la cual est a su vez limitada a la tecnologa actual.
Las primeras impresoras 3D al ser una tecnologa nueva fueron muy costosas y
poco accesibles para empresas pequeas o al pblico en general debido a su
inversin inicial.
Tambin el facilitar este tipo de sistemas permite que reas como las prtesis para
personas con capacidades especiales se las pueda personalizar y hacer a la
medida sin incurrir en costosos sistemas.
Para abordar este tema se requiere tanto una investigacin de las opciones que
actualmente brinda el mercado, as como tambin de un acercamiento a los
requerimientos de los usuarios.
Actualmente el mercado brinda opciones tanto para produccin en masa como para
pequea produccin de variada forma y tamao, a continuacin, se presenta las
impresoras 3D ms vendidas.
Segn un estudio realizado por 3D Hubs (3D Hubs Inc., 2016), se han llegado a
establecer los parmetros ms comunes al momento de adquirir una impresora 3D
los cuales son:
Esto ha provocado que los diferentes modelos de impresoras se los pueda clasificar
dentro 5 categoras principales, cada una con ms de 20 modelos hasta el 2016
Cabe recalcar que la base de datos que a continuacin se presenta est compuesta
por ms de 5000 revisores con casi 4000 horas de experiencia. (3D Hubs Inc.,
2016)
Enthusiast Model
En esta categora se encuentran las impresoras que brindan alta calidad y son
fiables para el usuario; son mquinas sencillas que permiten modificaciones y
tienen alta flexibilidad. Una de las principales caractersticas de esta es la
comunidad que da apoyo a los nuevos usuarios; son excelentes para aficionados,
diseadores y pequeas empresas. En la Figura 3-1 se muestran las 5 mejores
categoras.
20 3D Hubs fue fundada en 2013. Es la empresa pionera en utilizar la impresin 3D para crear
productos finales reales. 2015: 3D Hubs ha recaudado $ 4,5 millones en inversiones de capital
dirigidos por Balderton y ha ampliado el equipo que se encuentran en Nueva York y msterdam.
56
Budget
Kit /DIY
Estas impresoras estn hechas para personas que desean alterar las condiciones
y prestaciones de los productos, basadas en cdigo abierto. Presentan cierta
dificultad al momento de montar y calibrar, su calidad es comparable con otras
categoras, pero se puede mejorar los sistemas o hacer modificaciones.
Resin
Professional
Software Libre SI NO NO SI NO NO
Vol. de impresin
12 790 5 625 6 700 6 900 2 800 23 000
[cm3]
Usuarios
Intermedios Principiantes Intermedios Intermedios
Nivel de Cualquiera Profesionales
Profesionales Intermedios Profesionales Profesionales
conocimiento
Otro punto vital es que durante el presente estudio se pudo observar sistemas
actualmente existentes basados en cadenas cinemticas cerradas o comnmente
conocidos como robots paralelos. Estos se muestran a continuacin:
60
Rockstock MAX
Tiene un precio alrededor de $ 99921; Basada en los robots Delta con volumen de
construccin de dimetro de 18 cm y altura de 33 cm. Imprime a velocidades de 60
mm/s y tiene una resolucin de 20 micras.
Especificaciones
21 Anexo 2
61
ReRap Kossel
Especificaciones
22 Anexo 2
62
Que sea sencilla de Interfaz sencilla para Establecer elementos que brinden
Interfaz
usar control y calibracin informacin de funcionamiento al usuario.
Que haya repuestos Materiales y
Elementos de mayor Nivel de importancia al momento de
elementos de
distribucin en el mercado seleccionar opciones
construccin estndar
Que est lista para Infraestructura de
Sistema Plug n Play Elementos previamente calibrados
usar funcionamiento
Que los materiales se
Mtodo de adicin de Seleccionar mtodo de deposicin de
puedan conseguir Material de impresin
material FMD material adecuado
fcilmente
Que no sea Seleccin de elementos baratos del
Relativo bajo Costo Costo menor a 1000 USD
excesivamente costosa mercado.
Que tenga una
Calidad de impresin de Seleccionar mtodo de deposicin de
calidad buena al Mtodo de impresin
50 micrones material adecuado
momento de imprimir
Que imprima rpido Velocidad de Velocidad de impresin Seleccionar mtodo de posicionamiento
impresin mayor a 50 mm/s adecuado
Que sea compatible Compatibilidad de Compatibilidad con Elementos de control compatibles con la
con software actual. programacin programacin de cdigo G tecnologa de cdigo G
Que sea fcil dar Brindar una gua al usuario Establecer elementos estndar, que se
Mantenibilidad
mantenimiento del mantenimiento puedan encontrar en el mercado nacional.
Que pueda imprimir
Volumen de trabajo Disear sistema con esta rea de trabajo en
elementos de mediano Volumen de trabajo
alrededor de 25x25x30 cm el plano y se eleve hasta los 30cm
tamao
63
Debido a la variedad de acciones que conlleva la impresin 3D, se lleva a cabo una
divisin modular, la cual se rige por un cdigo de colores el cual separa a cada
mdulo de acuerdo a las funciones que cumple. Las principales funciones que
realiza la impresin 3D son:
1. Posicionar el sistema
2. Adicionar Material
Cada una de estas funciones se las divide en sub-funciones las cuales se muestran
a continuacin en la siguiente figura:
66
Este singular caso en particular, puede tener una solucin para ambas funciones
ya que las dos se basan en movimiento del sistema, estas alternativas son:
VENTAJAS DESVENTAJAS
Volumen de trabajo regular Baja velocidad
Pocos eslabones Sistema pesado
No posee singularidades Bajas aceleraciones
23 Figura extrada de: (R.C. Gonzalez; K.S. Fu; C.S.G Lee;, 1987, pgs. 3-6)
69
VENTAJAS DESVENTAJAS
Ligereza Espacio irregular de trabajo
Rigidez Mayor nmero de eslabones
Altas Aceleraciones y articulaciones
Altas Velocidades Singularidades
Por lo tanto, como se ha mencionado, dado que para las 2 funciones se puede tener
un solo sistema se tienen las siguientes alternativas:
Tabla 3-4 Evaluacin del peso especfico de cada criterio para el mdulo 1
Velocidad Material Mtodo Costo +1 Ponderacin
Velocidad 1 1 0,5 3.5 0.35
Material 0 1 0,5 1.5 0.15
Mtodo 0 0 0 2 0.20
Costo 0,5 0,5 1 3 0.30
suma 10.5 1
Velocidad = Costo > Mtodo > Material
VENTAJAS DESVENTAJAS
Rapidez Posibilidad de BUG
No requiere proteccin externa Costoso
Visualizacin de fallos Requiere Soporte tcnico adicional
Un mtodo parecido al anterior pero que conlleva directamente una placa dedicada
a la verificacin del funcionamiento de los actuadores del sistema y en caso de que
existiera un fallo, este solo mostrara una seal de alerta o emergencia.
VENTAJAS DESVENTAJAS
Rapidez Imposibilidad de re-configuracin
Seguridad Interdependencia de los elementos
Bajo Costo Requiere proteccin extra
VENTAJAS DESVENTAJAS
Bajo costo Requiere conocimiento
Parametrizable Requiere elementos extras
Orientada a elementos Susceptible a fallo
73
Una serie de pasos y procedimientos que el usuario del sistema deba realizar para
comprobar que todos los sistemas puedan funcionar antes de ser encendida la
mquina.
VENTAJAS DESVENTAJAS
Bajo costo Requiere elementos extra
Predispuesto a mejoras Requiere conocimientos especficos
Orientado a elementos Susceptible a fallo
Este mtodo nos permite obtener un punto de referencia del sistema, es decir el
0,0,0 del sistema de coordenadas.
VENTAJAS DESVENTAJAS
Contacto seguro Sufre desgaste
Rpidos Requiere mantenimiento
Reemplazables Solo se activa al contacto completo
Varios tipos de sensores como los inductivos basados en el efecto hall o los
fotoelctricos que permiten determinar la posicin en base a principios fsicos como
campo elctrico o potencial elctrico.
VENTAJAS DESVENTAJAS
Campo amplio de deteccin Costosos
Varios modelos Requiere calibracin
Reemplazables Susceptible a interferencias
VENTAJAS DESVENTAJAS
No requiere otro sistema Costoso
Rpidos Requiere extrapolacin
Varios modelos No son aplicables para pequeos
desplazamientos
Esta funcin puede ser realizada por diferentes sistemas mecnicos y electrnicos,
ya que son varios elementos capaces de mover el sistema a la posicin deseada
para que se pueda adicionar el material.
Solucin 1: Servomotores
Estos actuadores permiten alcanzar una altsima velocidad para los elementos que
posicionan el efector final del sistema de impresin 3D.
VENTAJAS DESVENTAJAS
Control de Velocidad Necesitan elementos de precisin
Variedad de modelos Requiere software de control
Bajo consumo de energa
VENTAJAS DESVENTAJAS
Control de Velocidad Requiere de Programacin
Movimientos Precisos No soporta grandes cargas
Bajo consumo de energa
Verificar el
estado del
sistema
Verificar la
posicin del
sistema
Controlar la
posicin del
sistema
Tabla 3-11 Evaluacin del peso especfico de cada criterio para el mdulo 2
Velocidad Material Mtodo Costo +1 Ponderacin
Velocidad 1 1 0,5 3.5 0.35
Material 0 1 0,5 1.5 0.15
Mtodo 0 0 0 2 0.20
Costo 0,5 0,5 1 3 0.30
suma 10 1
Velocidad = Costo > Mtodo > Material
78
Velocidad SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. +1 Ponderacin
1 2 3 4 5 6 7 8 9 10 11 12
SOL. 1 0,096
1 0 1 0 1 0,5 1 0 1 0 1 7,5
SOL. 2 0,045
0 0 0 0 1 0 0,5 0 0 0 1 3,5
SOL. 3 0,115
1 1 1 0 1 1 1 0 1 0 1 9
SOL. 4 0,045
0 1 0 0 0 0 1 0,5 0 0 0 3,5
SOL. 5 0,147
1 1 1 1 1 1 1 1 1 0,5 1 11,5
SOL. 6 0,071
0 0 0 1 0 1 1 0 1 0 0,5 5,5
SOL. 7 0,083
0,5 1 0 1 0 0 1 0 1 0 1 6,5
SOL. 8 0,019
0 0,5 0 0 0 0 0 0 0 0 0 1,5
SOL. 9 0,122
1 1 1 0,5 0 1 1 1 1 0 1 9,5
SOL. 10 0,051
0 1 0 1 0 0 0 1 0 0 0 4
SOL. 11 0,147
1 1 1 1 0,5 1 1 1 1 1 1 11,5
SOL. 12 0,058
0 0 0 1 0 0,5 0 1 0 1 0 4,5
SUMA 78 1
SOL.11 = SOL.5 > SOL.9 > SOL.3 > SOL.1 > SOL.7 > SOL.6 > SOL.12 > SOL.10 > SOL.2 > SOL.4 > SOL.8
Costo SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. +1 Ponderacin
1 2 3 4 5 6 7 8 9 10 11 12
SOL. 1 0,5 1 1 1 0,5 0,5 0,5 1 1 1 0,5 9,5 0,122
SOL. 2 0,5 1 1 1 0,5 0,5 0,5 1 1 1 0,5 9,5 0,122
SOL. 3 0 0 0,5 1 0,5 0 0 0,5 0,5 1 0,5 5,5 0,071
SOL. 4 0 0 0,5 1 0,5 0 0 0,5 0,5 1 0,5 5,5 0,071
SOL. 5 0 0 0 0 0,5 0 0 0 0 0,5 0,5 2,5 0,032
SOL. 6 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 7 0,5 0,5 1 1 1 0,5 0,5 1 1 1 1 10 0,128
SOL. 8 0,5 0,5 1 1 1 0,5 0,5 1 1 1 1 10 0,128
SOL. 9 0 0 0,5 0,5 1 0,5 0 0 0,5 1 1 6 0,077
SOL. 10 0 0 0,5 0,5 1 0,5 0 0 0,5 1 1 6 0,077
SOL. 11 0 0 0 0 0,5 0,5 0 0 0 0 0,5 2,5 0,032
SOL. 12 0,5 0,5 0,5 0,5 0,5 0,5 0 0 0 0 0,5 4,5 0,058
SUMA 78 1
SOL.5 = SOL.6 = SOL.11 = SOL.12 > SOL.3 = SOL.4 = SOL.9 = SOL.10 > SOL.1 = SOL.2 = SOL.7 = SOL.8
79
Mtodo SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. +1 Ponderacin
1 2 3 4 5 6 7 8 9 10 11 12
SOL. 1 0,5 0,5 0 0,5 0 0 0,5 0,5 0 0,5 0 4 0,051
SOL. 2 0,5 1 0,5 1 0 0,5 0,5 0,5 0,5 0,5 0,5 7 0,090
SOL. 3 0,5 0 0,5 0,5 0 0,5 0,5 0,5 0,5 0,5 0,5 5,5 0,071
SOL. 4 1 0,5 0,5 1 0,5 1 0,5 1 0,5 1 0,5 9 0,115
SOL. 5 0,5 0 0,5 0 0 0,5 0 0,5 0 0,5 0 3,5 0,045
SOL. 6 1 1 1 0,5 1 1 0,5 1 1 1 0,5 10,5 0,135
SOL. 7 1 0,5 0,5 0 0,5 0 0,5 0,5 0,5 0,5 0 5,5 0,071
SOL. 8 0,5 0,5 0,5 0,5 1 0,5 0,5 1 0,5 0,5 0,5 7,5 0,096
SOL. 9 0,5 0,5 0,5 0 0,5 0 0,5 0 0 0,5 1 5 0,064
SOL. 10 1 0,5 0,5 0,5 1 0 0,5 0,5 1 1 0,5 8 0,103
SOL. 11 0,5 0,5 0,5 0 0,5 0 0,5 0,5 0,5 0 0 4,5 0,058
SOL. 12 1 0,5 0,5 0,5 1 8 0,103
0,5 1 0,5 0 0,5 1
SUMA 78 1
SOL.6 > SOL.4 > SOL.10 = SOL.12 > SOL.8 > SOL.2 > SOL.3 = SOL.7 > SOL.9 > SOL.11 > SOL.1 > SOL.5
Material SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. SOL. +1 Ponderacin
1 2 3 4 5 6 7 8 9 10 11 12
SOL. 1 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 2 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 3 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 4 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 6 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 7 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 8 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 9 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 10 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 11 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SOL. 12 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 0,5 6,5 0,083
SUMA 78 1
SOL.1 = SOL.2 = SOL.3 = SOL.4 = SOL.5 = SOL.6 = SOL.7 = SOL.8 = SOL.9 = SOL.10 = SOL.11 = SOL.12
80
Tcnica aditiva que deposita el material en capas para conformar una pieza. Un
filamento se introduce en la boquilla la cual est a temperatura de fusin del
material, el cual es disponible en rollos, que enfra al salir de la boquilla y solidifica.
81
VENTAJAS DESVENTAJAS
Relativo bajo costo Verticalidad del efector final
Varios plsticos Baja resolucin
Solo requiere calor Solo termoplsticos
VENTAJAS DESVENTAJAS
Cualquier aleacin Alto costo
Alta resolucin Dependencia de otros sistemas
Control preciso
Tcnica que deposita capas de polvo, que conjuntamente con un lser CO2
sinteriza el polvo en los puntos en los que las partculas se fusionan, dando as
paso a que tome forma y se solidifique.
VENTAJAS DESVENTAJAS
Termoplsticos, metales y cermicos Alto costo
Alta resolucin Dependencia de otros sistemas
Alta adaptabilidad
Tambin se la conoce como fabricacin ptica que utiliza una resina, la cual se cura
mediante luz ultra violeta y un lser ultravioleta. La creacin es por capas que se
mueven hacia abajo y van dando la forma al sistema poco a poco.
VENTAJAS DESVENTAJAS
Se adapta a varias geometras rea de trabajo limitada
Alta resolucin Requiere un sistema de movimiento
Vertical extra
Tabla 3-18 Evaluacin del peso especfico de cada criterio para el mdulo 1
Velocidad Material Mtodo Costo +1 Ponderacin
Velocidad 0 0 0 1 0,10
Material 1 0,5 1 3,5 0,35
Mtodo 1 0,5 1 3,5 0,35
Costo 1 0 0 2 0,20
suma 10 1
Mtodo > Material > Costo > Velocidad
85
Una vez evaluadas las opciones de cada mdulo, se puede obtener una primera
iteracin del diseo conceptual del sistema, el cual deber contar con:
Una vez establecidos los parmetros para el diseo del sistema, se procede a
establecer un modelo funcional con la ayuda del software CAD SOLIDWORKS
2016.
En esta seccin se mostrarn los elementos que componen al sistema, sin sus
cotas para ver su geometra. Si se desea conocer sus dimensiones, estas se
encuentran detalladas en los planos del sistema al final del presente trabajo en el
Anexo 7.
89
Volumen:
0.000171031 m^3
Volumen:
1.07854e-005 m^3
Volumen:
2.34999e-005 m^3
90
Volumen:
1.82605e-005 m^3
Volumen:
4.82498e-007 m^3
Volumen:
1.95952e-006 m^3
91
3.8.4 ENSAMBLES
Figura 3-29 Extrusor del Sistema de adicin de material de Modelado por deposicin
fundida (FMD)
95
CAPTULO IV
4.1 INTRODUCCIN
De esta configuracin se puede obtener un modelo simple para cada brazo, si este
actuara independientemente en su plano de movimiento; Sin embargo, es
necesario considerar que en este mismo plano acta otro brazo del sistema, lo que
aumenta las ecuaciones necesarias para representar el mecanismo
matemticamente. Esta nueva configuracin se la puede observar en la Figura 4-5.
101
PAR DE REVOLUCIN EN A
Donde:
q = +|
PAR DE REVOLUCIN EN B
103
Donde:
PAR DE REVOLUCIN EN C
104
Donde:
PAR DE REVOLUCIN EN D
105
Donde:
PAR DE REVOLUCIN EN E
106
Donde:
PAR DE REVOLUCIN EN F
107
Donde:
Una vez analizadas los diferentes pares cinemticos del sistema en el plano XY, se
procede a igualar estas condiciones a cero lo que dar como resultado 12
ecuaciones de restriccin, 2 por cada junta de revolucin. (Mata V, 2015)
PAR DE REVOLUCIN EN A
>
(4-7)
PAR DE REVOLUCIN EN B
>
(4-8)
PAR DE REVOLUCIN EN C
>
(4-9)
PAR DE REVOLUCIN EN D
109
>
(4-10)
PAR DE REVOLUCIN EN E
>
(4-11)
PAR DE REVOLUCIN EN F
>
(4-12)
Los trminos de la matriz generada por cada par de revolucin representan una
ecuacin de restriccin independiente (EcRX), por lo que a continuacin y con
ayuda del software se extrae la expresin correspondiente para el anlisis del
sistema.
>
(4-13)
>
(4-14)
>
(4-15)
>
(4-16)
110
>
(4-17)
>
(4-18)
>
(4-19)
>
(4-20)
>
(4-21)
>
(4-22)
>
(4-23)
>
(4-24)
Una gran ventaja de este mtodo para modelar los sistemas mecnicos es la
facilidad que presenta para determinar las ecuaciones de velocidad y aceleracin
del sistema las cuales ayudarn a determinar el modelo dinmico del mismo. Por
lo que a continuacin se realiza un anlisis de las velocidades en base al tipo de
unin de los eslabones del sistema y as conocer el resultado.
PAR DE REVOLUCIN EN A
~
E1 P q1C E11 & E = | + E1N P 1C q1C E11 P q1C E11N & EN+ = |
~G
111
Donde:
>
(4-25)
PAR DE REVOLUCIN EN B
~
E2 P q2C E22 & E1 & q1C E11 = | +
~G
E1N P 1C q1C E11 P q1C E11N & E2N & 2C q2C E22 & q2C E22N = |
Donde:
>
(4-26)
112
PAR DE REVOLUCIN EN C
~
E2 P q2C E25 & E5 & q5C E55 +
~G
E2N P 2C q2C E25 P q2C E25N & E5N & 5C q5C E55 & q5C E5F5N = |
Donde:
>
(4-27)
PAR DE REVOLUCIN EN D
~
E3 P q3C E33 & E4 & q4C E44 +
~G
E3N P 3C q3C E33 P q3C E33N & E4N & 4C q4C E44 & q4C E43N = |
Donde:
>
(4-28)
113
PAR DE REVOLUCIN EN E
~
3 P q3C E33 & E4 & q4C E44 +
~G
E3N P 3C q3C E33 P q3C E33N & E4N & 4C q4C E44 & q4C E43N = |
Donde:
>
(4-29)
PAR DE REVOLUCIN EN F
~
4 P q4C E44 & E5 & q5C E55 +
~G
E4N P 4C q4C E4;4 P q4C E4;4N & E5N & 5C q5C E5;5 & q5C E5;5N = |
Donde:
(4-30)
114
>
(4-31)
>
(4-32)
>
(4-33)
>
(4-34)
>
(4-35)
>
(4-36)
>
(4-37)
>
(4-38)
>
(4-39)
>
(4-40)
>
(4-41)
>
(4-42)
115
PAR DE REVOLUCIN EN A
~
E1N P 1C q1C E11 P q1C E11N & EN+ = |
~G
Donde:
>
(4-42)
116
PAR DE REVOLUCIN EN B
+E1N P 1C q1C E11 P q1C E11N & E2N & 2C q2C E22 & q2C E22N = |
~
E17 P +1C q1C E11 P 1C 1C q1C E11 P 1C q1C E11N P 1C q1C E11N
~G
P q1C E117 & E27 & +2C q2C E22 & 2C 2C q2C E22 & 2C q2C E22N
& 2C q2C E22 & +q2C E227
Donde:
(4-43)
PAR DE REVOLUCIN EN C
E2N P 2C q2C E25 P q2C E25N & E5N & 5C q5C E55 & q5C E5F5N = |
~
+ E27 P +2C q2C E25 P 2C 2C q2C E25 P 2C q2C E25N P 2C q2C E25N
~G
P +q2C E257 & E57 & +5C q5C E55 & 5C 5C q5C E55 & 5C q5C E55N
& 5C q5C E55N & q5C E557+
Donde:
117
>
(4-44)
PAR DE REVOLUCIN EN D
E3N P 3C q3C E33 P q3C E33N & E4N & 4C q4C E44 & q4C E43N = |
~
+ E37 P +3C q3C E3"3 P +3C 3C q3C E3"3 P 3C q3C E3"3N P 3C q3C E3"3N
~G
P q3C E3"37 & E"7
Donde:
>
(4-45)
PAR DE REVOLUCIN EN E
E3N P 3C q3C E33 P q3C E33N & E4N & 4C q4C E44 & q4C E43N = |
118
~
+ ++E37 P +3C q3C E33 P 3C 3C q3C E33 P 3C q3C E33N P +3C q3C E33N
~G
P +q3C E337 & E47 & +4C q4C E44 & 4C 4C q4C E44
& 4C q4C E44N & 4C q4C E44N & +q4C E447+
Donde:
>
(4-46)
PAR DE REVOLUCIN EN F
E4N P 4C q4C E4;4 P q4C E4;4N & E5N & 5C q5C E5;5 & q5C E5;5N = |
~
E47 P +4C q4C E4;4+ P 4C 4C q4C E4;4 P 4C q4C E4;4N P 4C q4C E4;4N
~G
P +q4C E4;47 & E57 & +5C q5C E5;5 & 5C 5C q5C E5;5 & 5C q5C E5;5N
& 5C q5C E5;5N & +q5C E5;57
Donde:
119
>
(4-47)
>
(4-48)
>
(4-49)
>
(4-50)
>
(4-51)
>
120
(4-52)
>
(4-53)
>
(4-54)
>
(4-55)
>
(4-56)
>
(4-57)
>
(4-58)
>
(4-59)
<18 >18 18 <28 >28 28 <38 >38 38 <48 >48 48 <58 >58 5
De las cuales 1+>++3 son las variables independientes del sistema a controlar, lo
que nos deja con 13 variables y 12 ecuaciones para la resolucin del sistema,
haciendo que sea requerida una ecuacin ms para as caracterizar el sistema.
Posicin:
>
(4-63)
Velocidad:
>
(4-64)
Aceleracin:
>
(4-65)
123
Una vez establecidas las ecuaciones del modelo cinemtico, as como sus
variables. Se puede abordar el problema dinmico de la misma manera con
coordenadas generalizadas en base a la Figura 4-5.
&+ = ++
a a
(2-45)
# = + & + (2-46)
7 : Coordenadas articulares
Donde:
: Energa cintica
Energa potencial
124
Por eso para el anlisis dinmico del sistema se considerar a la accin del peso
como una fuerza externa y dentro de la formulacin de LaGrange Euler solo se
tomar en cuenta la energa cintica del sistema.
F = , $ $ , P , $ $ , +
* *
(4-66)
ESLABON A-B
tttttttttu
lVr = + ttttttu ttttttu ttttu
x* = * P l
ttttu
Donde:
+ l = |u P +|u+(El punto A est fijo en el robot)
u u tu
ttttttu tttttuq
* = + 1 ttttttu | | 1 = &1 $ #* % u P 1 $ #* F u
x* = e z
#* #* 2 *
2 *
F* %* |
2 2
#* #*
tttttttttu
lVr = &1 $ B%* u + P +1 $ F* u+
2 2
#* ,
#* ,
lVr = &1 $ B%* P ++1 $ F*
2 2
En consecuencia, la energa cintica del eslabn A-B es:
1 #* ,
#* ,
1
FlVr = $ * $ &1 $ B%* P 1 $ F* P $ * $ *,
2 2 2 2
(4-67)
126
ESLABON B-C
Donde:
u u tu
ttttu
tttttu tttttu
r = 1qr = e | | 1
#* F* #* %* |
= &1 $ #* %* u P ++1 $ #* F* +u
u u tu
ttttttu tttttuq
, = + 2 ttttttu | | 2
x, = e z
#, #,
F, %, |
2 2
#, #,
= &2 $ %, u P 2 $ F, u
2 2
127
#, #,
tttttttttu
rV = &1 $ #* %* & 2 $ %, u ++ P 1 $ #* F* P 2 $ F, u+
2 2
#, ,
#, ,
rV = + &1 $ #* %* & 2 $ %, P 1 $ #* F* P 2 $ F,
2 2
1 #, ,
FrV = $ , $ (&1 $ #* %* & 2 $ %, +
2 2
,
P 1 $ #* F* P 2 $ F, ) P $ , $ ,,
ai *
, ,
(4-68)
ESLABON D-E
tttttttttu
V = + ttttttu ttttttu ttttu
x- = - P
Donde:
ttttu
= |u P +|u+
128
u u tu
ttttttu tttttuq
- = + 3 ttttttu | | 3 = &3 $ #* % u P 3 $ #* F u
x- = e z
#* #* 2 -
2 -
F- %- |
2 2
#* #*
tttttttttu
V = &3 $ %- u + P 3 $ F- u+
2 2
#* ,
#* ,
V = &3 $ %- P 3 $ F-
2 2
1 #* ,
#* ,
1
FV = $ - $ &3 $ %- P 3 $ F- P $ - $ -,
2 2 2 2
(4-69)
ESLABON E-F
Donde:
u u tu
ttttu tttttuq
= 2 ttttu
= e | | 3 = &3 $ #* %- u P ++1 $ #* F- +u
#* F- #* %- |
u u tu
tttttuq
. = + 4 ttttttu | | 4 = &4 $ #, % u P 4 $ #, F u
x. = e z
#, #, 2 .
2 .
F. %. |
2 2
#, #,
Reemplazando y agrupando se obtiene:
tttttttttu
V = &3 $ #* %- & 4 $ %. u + P +3 $ #* F- P 4 $ F. u+
2 2
#, ,
#, ,
V = &3 $ #* %- & 4 $ %. P 3 $ #* F- P 4 $ F.
2 2
En consecuencia, la energa cintica del eslabn E-F es:
1 #, ,
FV = $ . $ (&3 $ #* %- & 4 $ %.
2 2
,
P 3 $ #* F- P 4 $ F. ) P , $ . $ .,
ai *
,
(4-70)
ESLABON F-C
tttttttttu
V = + ttttttu ttttttttttu ttttttttttu
x/ = + x/ P x/
Donde:
ttttttttttu
x/ = ++ tttttttttu ttttttttu
, P r +
u u tu
ttttttttu
r = 1 tttttuq
tttttu
r = e | | 1
#* F* #* %* |
= &1 $ #* %* u P ++1 $ #* F* +u
u u tu
tttttttttu
tttttu ttttu
, = + 2q = e | | 2
#, F, #, %, |
= &2 $ #, %, u P 2 $ #, F, u
ttttttttttu
x/ = + [&1 $ #* %* & 2 $ #, %, ]u ++ P [1 $ #* F* P 2 $ #, F, ]u+
ttttttttttu
tttttttttu ttttttttu
x/ = + . P
u u tu
ttttttttu
tttttu ttttu
= 2q = e | | 3 = &3 $ #* %- u P ++3 $ #* F- +u
#* F- #* %- |
u u tu
. tttttuq
= + 4 ttttu
= e | | 4 = &4 $ #, %. u P 4 $ #, F. u
#, F. #, %. |
ttttttttttu
x/ = [&3 $ #* %- & 4 $ #, %. ]u + P [+3 $ #* F- P 4 $ #, F. ]u+
131
tttttttttu
V = + [&1 $ #* %* & 2 $ #, %, & 3 $ #* %- & 4 $ #, %. ]u
++P[1 $ #* F* P 2 $ #, F, P +3 $ #* F- P 4 $ #, F. ]u++
P[1 $ #* F* P 2 $ #, F, P +3 $ #* F- P 4 $ #, F. ], }*,
1
FV = $ / $ ([&1 $ #* %* & 2 $ #, %, & 3 $ #* %- & 4 $ #, %. ],
2
P+[1 $ #* F* P 2 $ #, F, P +3 $ #* F- P 4 $ #, F. ], ) (4-71)
1 #* ,
#* ,
1
F0d = + $ * $ &1 $ B%* P 1 $ F* P $ * $ *, P
2 2 2 2
1 #, ,
#, ,
1
+ $ , $ &1 $ #* %* & 2 $ %, + P 1 $ #* F* P 2 $ F, + P $ , $ ,, P
2 2 2 2
1 #* ,
#* ,
1
+ $ - $ &3 $ %- P 3 $ F- P $ - $ -, + P
2 2 2 2
1 #, ,
#, ,
1
+ $ . $ &3 $ #* %- & 4 $ %. P 3 $ #* F- P 4 $ F. P + $ . $ ., P
2 2 2 2
#, F, P +3 $ #* F- P 4 $ #, F. ], ) (4-72)
132
Del mismo modo que se analiz la energa cintica. Se tomar cada eslabn para
su estudio utilizando el principio de trabajos virtuales para determinar el trabajo
externo generado en el sistema y as poder tomar estos parmetros dentro de la
formulacin de LaGrange-Euler.
133
ESLABON A-B
y1 y1
ttttttu
;:* =
# , cos(1 P |) u P
# ,
sen(1 P |) u+
I 1M I 1M
2 2
4 $ y1 4 $ y1
+= & %1 u P + F1 u+
#1 2
#1 2
4 $ y1 4 $ y1
tttttttttu
; O* = + & %1 u P + F1 u + & * $ H+u+
#1 2
#1 2
lVr =
#1 #1 4 $ y1 4 $ y1
T& B%1 C 1 +u P F1 C 1 +u+W C T+& %1 u P + F1 u + & * $ H+u+W
2 2 #1 2
#1 2
4 $ y1 #1 4 $ y1 #1
lVr = + & %1 $ & B%1 C 1 P+ F1 $ F1 C 1 +
#1 2
2 #1 2
2
&* $ H $ F1 C 1
#1
2
(4-73)
ESLABON B-C
rV = +EvVv, +C ;O, +
134
#2 #2
ttttttttttttttttu
E vVv, = +(qu P F2 u P B%2 +u P #1 F1 u P #1 B%1 +u++)
2 2
#2 #2
ttttttttttttttttu
E vVv, = + & B%2 C 2 u + P F2 C 2 +u & #1 B%1 C 1 +u P #1 F1 C 1 +u+
2 2
tttttttttu
; ttttu
O, = k,
#2 #2
rV = T& B%2 C 2 u + P F2 C 2 +u & #1 B%1 C 1 +u P #1 F1 C 1 +u+W C (&, $ H+u)
2 2
rV = &, $ H $ F2 C 2 + & , $ H $ #1 F1 C 1
#2
2
(4-74)
ESLABON D-E
V = +EvVv- +C ;O- +
#1 #1
ttttttttttttttttu
E vVv- = +(&qu P F3 u P B%3 +u+++)
2 2
#1 #1
ttttttttttttttttu
E vVv* = + & B%3 C 3 +u P F3 C 3 +u+
2 2
tttttttttu
; ttttttu ttttu
O- = ;:- P + k-
4 $ y3 4 $ y3
ttttttu
; :- = & %3 u P + F3 u+
#1 2
#1 2
4 $ y3 4 $ y3
tttttttttu
;O- = + & %3 u P + F3 u ++ & - $ H+u+
#1 2
#1 2
lVr =
#1 #1 4 $ y3 4 $ y3
T& B%3 C 3 +u P F3 C 3 +u+W C T+& %3 u P + F3 u ++ & - $ H+u++W
2 2 #1 2
#1 2
4 $ y3 #1 4 $ y3 #1
V = + & %3 $ & B%3 C 3 P+ F3 $ F3 C 3 +
#1 2
2 #1 2
2
135
&- $ H $ 21 F3 C 3
#
(4-75)
ESLABON E-F
V = +EvVv. +C ;O. +
#2 #2
ttttttttttttttttu
E vVv. = +(&qu P F4 u P B%4 +u P #1 F3 u P #1 B%3 +u++)
2 2
#2 #2
ttttttttttttttttu
E vVv, = + & B%4 C 4 u + P F4 C 4 +u & #1 B%3 C 3 u P #1 F3 C 3 +u+
2 2
tttttttttu
;O. = k tttttu
.,
tttu
k. = + &. $ H+u
#2 #2
V = T& B%4 C 4 u + P F4 C 4 +u & #1 B%3 C 3 u P #1 F3 C 3 +u+W C (&. $ H+u)
2 2
V = &. $ H $ 2 F4 C 4 + & . $ H $ #1 F3 C 3
#
2
(4-76)
ESLABON F-C
Debido a que el eslabn F-C es dependiente de las acciones de los 2 brazos de giro, se
considerar el trabajo generado por cada lado del sistema.
V = +EvVv/ +C ;O/
tttttttttttttttttttu
EvVv/ = + E1 tttttttttttttttttttu
vVv/ P E2vVv/ +
tttttttttttttttttttu
E1 vVv/ = +(qu P #2 F2 u P #2 B%2 +u P #1 F1 u P #1 B%1 +u + & Eu++)
tttttttttttttttttttu
E2 vVv/ = +(&qu P #2 F4 u P #2 B%4 +u P #1 F3 u P #1 B%3 +u P Eu+)
#2 #2
tttttttttttttttttttu
E1 vVv, = + & B%2 C 2 u + P F2 C 2 +u & #1 B%1 C 1 +u P #1 F1 C 1 +u+
2 2
#2 #2
tttttttttttttttttttu
E2 vVv, = + & B%4 C 4 u + P F4 C 4 +u & #1 B%3 C 3 u P #1 F3 C 3 +u+
2 2
136
ttttttttttttttttu
E vVv/ =  B%1 C 1 +u P #1 F1 C 1 +u & #2 B%2 C 2 u + P #2 F2 C 2 +u & #1 B%3 C 3 u
P #1 F3 C 3 +u + & #2 B%4 C 4 u + P #2 F4 C 4 +u
tttttttttu
; ttttu
O/ = k/
ttttu
k/ = &/ $ H+u
0d = lVr P rV P V P V P V
4 $ y1 #1 4 $ y1 #1
0d = ++ & %1 $ & B%1 C 1 P+ F1 $ F1 C 1 + & * $H
#1 2 2 #1 2 2
#1 #2 4 $ y3
$ F1 C 1 & , $ H $ F2 C 2 + & , $ H $ #1 F1 C 1 ++ & %3
2 2 #1 2
#1 4 $ y3 #1 #1
$& B%3 C 3 P+ F3 $ F3 C 3 + & - $H$ F3 C 3 + & . $H
2 #1 2
2 2
#2
$ F4 C 4 + & . $ H $ #1 F3 C 3 + & / $ H#1 F1 C 1 & / $ H
2
$ #2 F2 C 2 + & / $ H $ #1 F3 C 3 & / $ H $ #2 F4 C 4
Para determinar el trabajo de cada fuerza externa se debe agrupar por cada
variacin (delta) de coordenada articular del sistema.
137
#1 F3 3 P &. $ H $ 22 F4 & / $ H $ #2 F4 4
#
(4-78)
* 8 , 8 - 8 . 8 /
articulares, las cuales seran:
/ = 1| = F%GD%G
/ $ H#* F* (4-79)
, = &, $ H $ F, & / $ H $ #, F,
ai
,
(4-80)
H $ #* F- (4-81)
. = &. $ H $ F. & / $ H $ #, F.
ai
,
(4-82)
~ # #
&+ = +
~G 7 70
138
70 = (* 8 , 8 - 8 . )+
7 = +(* 8 , 8 - 8 . )+
1 #1 #1 1 1
# = + FBGD = + $ 1 $ T&1 $ %1 P 1 $ F1 W P $ 1 $ 21 P ++ $ 2
2 2
2 2 2 2 2
#2 #2 1 1
$ T&1 $ #1 %1 & 2 $ %2 + P 1 $ #1 F1 P 2 $ F2 W + P $ 2 $ 22 P ++ $ 3
2 2
2 2 2 2
#1 #1 1 1
$ T&3 $ %3 P 3 $ F3 W P $ 3 $ 23 + P ++ $ 4
2 2
2 2 2 2
#2 #2 1 1
$ T&3 $ #1 %3 & 4 $ %4 P 3 $ #1 F3 P 4 $ F4 W P + $ 4 $ 24 P + $ 5
2 2
2 2 2 2
$ ([&1 $ #1 %1 & 2 $ #2 %2 & 3 $ #1 %3 & 4 $ #2 %4 ]2 +
P + [1 $ #1 F1 P 2 $ #2 F2 P +3 $ #1 F3 P 4 $ #2 F4 ]2 )
(4-83)
* $ #* , *
# = P + *, P
2
, $ #* , $ *, , $ #, , $ ,, , $ #* $ #, $ 1 $ 2 $ F* F, , $ #* $ #, $ 1 $ 2 $ %* %, 1
P+ P+ P+ P $ , $ ,,
2 2 2 2 2
- $ #* , -
P + P + -, +
2
. $ #* , $ -, . $ #, , $ ., . $ #* $ #, $ 3 $ 4 $ F- F.
P+ P+ P+
2 2 2
. $ #* $ #, $ 3 $ 4 $ %- %. 1
P+ P + $ . $ .,
2 2
1
P+ $ / [#* , $ *, P 2 $ #* , $ 1 $ 3 $ F* F- P 2 $ #* , $ 1 $ 3 $ %* %- P + #* , $ -, P
2
2 $ #* $ #, $ 1 $ 2 $ F* F, P 2 $ #* $ #, $ 1 $ 2 $ %* %, P
2 $ #* $ #, $ 1 $ 4 $ F* F. P 2 $ #* $ #, $ 1 $ 4 $ %* %. P
2 $ #* $ #, $ 2 $ 3 $ F, F- P 2 $ #* $ #, $ 2 $ 3 $ %, %- P
2 $ #* $ #, $ 3 $ 4 $ F- F. P 2 $ #* $ #, $ 3 $ 4 $ %- %. P
#, , $ ,, P 2 $ #, , $ 2 $ 4 $ F, F. P 2 $ #, , $ 2 $ 4 $ %, %. P + #, , $ ., ]
(4-84)
139
~ # #
&+ = *
~G * *
* $ #*, 2
P + * P + , $ #* , P / $ #* , 1 P $ #1 $ #2cos+(1 & 2) P+5 $ #1 $ #2 $ cos+(1 & 2) 2 P 5 $ #1 2 $ cos+(1 & 3)+ 3
4 2
2
P [5 $ #1 $ #2 $ cos+(1 & 4)]4++ P $ #1 $ #2 $ %(1 & 2) P+5 $ #1 $ #2 $ %(1 & 2 ) 2,
2
P +/ $ #*,%(* & - )3, ++ P [/ $ #* $ #, %(* & .)]4,
4 $ y1 #* 4 $ y1 #* #*
=+& %* $ & B%* P + F* $ F* & * $ H $ F* & , $ H $ #* F* & / $ H#* F*
#*, 2 #* , 2 2
(4-85)
~ # #
&+ = ,
~G , ,
1
$ , $ #* $ #, $ F(* & ,) P / $ #* $ #, $ F(* & ,) 1 P , $ #, , P , P / $ #, ,2 P [/ $ #* $ #, $ F(, & -)]3
2
1
P / $ #,, $ F(, & .)4 P $ , $ #* $ #, $ %(, & *) P / $ #* $ #, $ %(, & *) 1,
2
#,
[
P / $ #* $ #, $ %(, & -)]3, P [/ $ #, , $ %(, & .)]4, = + &, $ H $ F, & / $ H $ #, F,
2
(4-86)
~ # #
&+ = -
~G - -
- $ #* , 1
[/ $ #*, $ F(* & -)]1 P [/ $ #* $ #, $ F(, & -)]2 P [ P + - P . $ #*, P + / $ #* , ]3 P [ . $ #* $ #, $ F(- & .) P /
4 2
1
$ #* $ #, $ F(- & .)]4 P [/ $ #* $ %(- & *)]1 P [/ $ #* $ #, $ %(- & ,)]2, P [ . $ #* $ #, $ %(-
, ,
2
& .) P / $ #* $ #, $ %(- & .)]4,
4 $ y3 #* 4 $ y3 #* #*
=& %- $ & B%- P + F- $ F- & - $ H $ F- & . $ H $ #*F- & / $ H $ #* F-
#*, 2 #*, 2 2
(4-87)
140
~ # #
&+ = .
~G . .
1
[/ $ #* $ #, $ F(* & . )]1 P / $ #, , $ F(, & . )2 P . $ #* $ #, $ F(- & . ) P / $ #* $ #, $ F(- & . ) 3
2
P . $ #, , P . P + / $ #, , 4 P [/ $ #* $ #, $ %(. & * )]1, P / $ #, , $ %(. & , )2,
1
P . $ #* $ #, $ %(. & - ) P + / $ #* $ #, $ %(. & - ) 3,
2
#,
= &. $ H $ F. & / $ H $ #, F.
2
Una vez obtenidas las ecuaciones que relacionan las fuerzas del sistema con sus
variables articulares, es recomendable preparar un arreglo matricial de tal forma
que se pueda evaluar y sea fcil de trabajar en el futuro para el desarrollo de
software capaz de simular los movimientos del sistema.
Donde:
MATRIZ DE MASAS R
q11 = * $ #* , P + * P + , $ #* , P / $ #* ,
*
.
q22 = + , $ #, , P , P / $ #, ,
q23 = + / $ #* $ #, $ F(, & - )
q24 = + / $ #, , $ F(, & . )
q31 = + / $ #* , $ F(* & - )
q44 = . $ #, , P . P + / $ #, , +
MATRIZ DE MASAS I
11 = |
22 = +|
23 = + &(/ $ #* $ #, $ %(, & - ))
24 = + &(/ $ #, , $ %(, & . ))
31 = + &(/ $ #* , $ %(* & - ))
33 = +|
34 = &( . $ #* $ #, $ %(- & . ) P / $ #* $ #, $ %(- & . ))
*
,
44 = |+
/ $ H#* F*
,Z = + &, $ H $ F, & / $ H $ #, F,
ai
,
#* F-
.Z = &. $ H $ F. & / $ H $ #, F.
ai
,
D = Dy P D
Dy = C +
142
D = q $ ,
D = C P q $ ,
Estas aceleraciones multiplicadas por la masa del elemento, segn la segunda ley de
Newton son:
;E?D = DD $ DFEDFB%
;E?D = ;E?D+<GE%D+
DD = DGEBF+~+DD+q++
DFEDFB% = C P q $ , +
143
CAPTULO V
5. SIMULACIN DEL SISTEMA
5.1 INTRODUCCIN
Utilizando los datos del punto 5.2 en especial los de la figura 5-1, se procede a
realizar un anlisis de convergencia utilizando el algoritmo de Newton-Rhapson.
>
>
>
>
>
>
>
145
>
>
>
>
>
>
>
5.3.5 Jacobiano
5.3.5.1 Dependiente
>
>
>
5.3.5.2 Independiente
>
147
>
>
5.3.6Evaluacin
>
>
>
148
>
>
149
Para evaluar esta condicin partimos del mismo punto anterior y con los resultados
obtenidos de posicin, se considerar este punto en reposo para verificar que no
existan valores mviles en dicho estado y corroborar los resultados.
>
>
>
>
150
>
>
>
>
>
>
>
>
>
>
151
>
5.4.5 Jacobiano
5.4.5.1 Dependiente
>
>
152
>
>
5.4.5.2 Independiente
>
>
>
5.4.6 Evaluacin
>
153
>
>
>
>
>
>
>
>
>
>
>
>
>
155
>
>
>
>
>
156
5.5.5 Jacobiano
5.5.5.1 Dependiente
>
>
>
5.5.5.2 Independiente
>
>
>
158
5.5.6 Evaluacin
>
>
>
>
>
A partir de la Matriz compacta del modelo dinmico, se puede obtener una grfica
de la respuesta del sistema a partir de una seal de entrada del actuador.
CAPTULO VI
6.1 INTRODUCCIN
Los costos del sistema se evaluarn en conformidad de verificar si el sistema es
factible de producir a cierta escala y orientado a un mercado en el que cuenta con
varias opciones para los consumidores.
Materiales
Elementos Normalizados
Costo de Maquinado
Costo de Montaje
Brazo de Giro
Barra Larga
Eje de Rotacin
Base Inferior
Base Superior
Elementos Normalizados
6.2.2 MAQUINADO
6.2.3 MONTAJE
CAPTULO VII
7. CONCLUSIONES
CAPTULO VIII
8. RECOMENDACIONES
Bibliografa
[3] ASIMOV Isaac. (1942). Runaround. New York: Street & Smith.
[8] Corke P.I. (2011). Robotics, Vision & Control: Fundamental aLgorithms in
MATLAB. Springer: ISBN 978-3-642-20143-1.
[11] Denavit, J., & Hartenberg, R. S. (1955). A kinematic notation for lower-
pair mechanisms based on matrices. ASME Journal of Applied Mechanisms
23, 215-221.
[17] Liu, K. (1992). Control of a stewart platform based robotic milling cell.
Proc. of ASME Winter Annual meeting, Symp. on Manufacturing and control
issues in a telerobotics assembly workcell, 8-13.
[18] Macdonald, E. R., Espalin, D., Perez, M., Aguilera, E., Muse, D., &
Wicker, R. B. (2014). 3D Printing for the Rapid Prototyping of Structural
Electronics. IEEE Access (Volume:2, 234 - 242.
[24] N. Hornyak, T. (2006). Loving the Machine: The Art and Science of
Japanese Robots. New York: Kodansha International.
170
[28] Pierrot F, H, C., O, C., A, K., T, S., & Uchiyama. (2003). Design and
Control of a Novel 4-DOFs Parallel Robot. Proceedings of the 2001 IEEE
international conference on robotics & automation, 3256-3261.
[30] R.C. Gonzalez; K.S. Fu; C.S.G Lee;. (1987). Robotics: Control,
Sensing, Vision, and Intelligence. New York: MC Graw Hill.
[34] Tsai, L. W. (1999). Robot Analysis: the mechanics of serial and parallel
manupulators. Wiley Interscience.
ANEXOS
ANEXO 1
PROGRAMACIN JUNTAS DE REVOLUCIN
ROBOT PARALELO
Preparar el Algoritmo
>
>
Cargar Newton-Rhapson
>
>
>
>
Ecuaciones de Posicin
Par de Revolucin en A
>
>
>
>
>
>
Par de Revolucin en B
>
>
>
>
>
Par de Revolucin en C
>
>
>
>
>
>
Par de Revolucin en D
>
>
>
>
>
>
Par de Revolucin en E
>
>
>
>
>
Par de Revolucin en F
>
>
>
>
ANEXO 2
PROFORMAS EQUIPOS
ANEXO 3
DERIVACIN DE LAS ECUACIONES
* $ #* , *
# = P + *, P
2
, $ #* , $ *, , $ #, , $ ,, , $ #* $ #, $ 1 $ 2 $ F* F, , $ #* $ #, $ 1 $ 2 $ %* %, 1
P+ P+ P+ P $ , $ ,,
2 2 2 2 2
- $ #* , -
P + P + -, +
2
. $ #* , $ -, . $ #, , $ ., . $ #* $ #, $ 3 $ 4 $ F- F.
P+ P+ P+
2 2 2
. $ #* $ #, $ 3 $ 4 $ %- %. 1
P+ P + $ . $ .,
2 2
1
P+ $ / [#* , $ *, P 2 $ #* , $ 1 $ 3 $ F* F- P 2 $ #* , $ 1 $ 3 $ %* %- P + #* , $ -, P
2
2 $ #* $ #, $ 1 $ 2 $ F* F, P 2 $ #* $ #, $ 1 $ 2 $ %* %, P
2 $ #* $ #, $ 1 $ 4 $ F* F. P 2 $ #* $ #, $ 1 $ 4 $ %* %. P
2 $ #* $ #, $ 2 $ 3 $ F, F- P 2 $ #* $ #, $ 2 $ 3 $ %, %- P
2 $ #* $ #, $ 3 $ 4 $ F- F. P 2 $ #* $ #, $ 3 $ 4 $ %- %. P
#, , $ ,, P 2 $ #, , $ 2 $ 4 $ F, F. P 2 $ #, , $ 2 $ 4 $ %, %. P + #, , $ ., ]
VARIABLE ARTICULAR
~ # #
&+ = *
~G * *
# , $ #* $ #, $ 1 $ 2 $ &B%* F, , $ #* $ #, $ 1 $ 2 $ F* %,
=+ P ++ P
* 2 2
/ $ #* $ #, $ 1 $ 2 $ F* %, P + / $ #* $ #, $ 1 $ 4 $ (&B%* )F. P / $ #* $ #, $ 1 $ 4 $ F* %.
+
# * $ #* , * 1 1 1
=+ P + 2 $ 1 P $ , $ #* , $ 2 $ 1++ P + $ , $ #* $ #, $ 2 $ F* F, P + $ , $ #* $ #, $ 2
* 2 2 2 2
$ %* %, P + #* , $ 2 $ 1 P / $ #* , $ 3 $ F* F- P / $ #* , $ 3 $ %* %- P + / $ #* $ #,
$ 2 $ F* F, P / $ #* $ #, $ 2 $ %* %, P + / $ #* $ #, $ 4 $ F* F. P / $ #* $ #, $ 4
$ %* %.
~ #
=
~G *
* $ #* , * , , ,
P + 2 $ 1+ P , $ #* , $ 1 P $ #* $ #, $ F* F, $ 2 P $ #* $ #, $ 2 $ (&%* )F, $ 1 P $ #*
2 2 2 2
1 1
$ #, $ 2 $ F* $ (&%, ) $ 2 P + $ , $ #* $ #, $ %* %, $ 2 P + $ , $ #* $ #, $ 2
2 2
1
$ F* %, $ 1 P + $ , $ #* $ #, $ 2 $ %* F, $ 2 P / $ #* $ 1 P / $ #* , $ F* F- $ 3+
,
2
P / $ #* , $ 3 $ (&%* )F- $ 1+ P + / $ #* , $ 3 $ F* (&%- ) $ 3+ P / $ #* , $ %* %-
$ 3 P 2 $ #* , $ 3 $ F* %- $ 1+ P + / $ #* , $ 3 $ %* $ F- $ 3+ P + / $ #* $ #, $ F* F,
$ 2 P + / $ #* $ #, $ 2 $ (&%* )F, $ 1 P + / $ #* $ #, $ 2 $ F* (&%, ) $ 2 P / $ #* $ #,
$ %* %, $ 2 P / $ #* $ #, $ 2 $ F* %, $ 1 P / $ #* $ #, $ 2 $ %* F, $ 2+ P / $ #*
$ #, $ F* F. $ 4 P / $ #* $ #, $ 4(&%* )F. $ 1 P / $ #* $ #, $ 4 $ F* (&%. ) $ 4+
P / $ #* $ #, $ %* %. $ 4 P / $ #* $ #, $ 4 $ F* %. $ 1 P / $ #* $ #, $ 4 $ %* F.
$ 4
~ # * $ #* ,
= P + * P + , $ #* , P / $ #* , 1
~G * 4
, 1
P $ #* $ #, $ F* F, P + $ , $ #* $ #, $ %* %, P + / $ #* $ #, $ F* F, P / $ #* $ #,
2 2
$ %* %, 2 P / $ #* , $ F* F- P / $ #* , $ %* %- +3
P [/ $ #* $ #, $ F* F. P / $ #* $ #, $ %* %. ]4 P
, ,
+ $ #* $ #, (&%* )F, P $ #* $ #, $ F* %, P + / $ #* $ #, (&%* )F, P / $ #* $ #, $ F* %, 1 $ 2+
2 2
P [/ $ #* $ #, (&%* )F. + P / $ #* $ #, $ F* %. ]1 $ 4
P / $ #* , (&%* )F- P / $ #* , $ F* %- 1 $ 3+
, 1
P $ #* $ #, $ F* (&%, ) P + $ , $ #* $ #, $ %* F, P / $ #* $ #, $ F* (&%, ) P / $ #*
2 2
$ #, $ %* F, 2, P +/ $ #* , $ F* (&%- ) P + / $ #* , $ %* $ F- 3, ++ P [/ $ #* $ #,
$ F* (&%. ) P / $ #* $ #, $ %* F. ]4, +
~ # #
&+ =
~G * *
* $ #* , ,
P + * P + , $ #* , P / $ #* , 1 P $ #* $ #, cos+(* & , ) P + / $ #* $ #, $ cos+(* & , ) 2
4 2
P / $ #* , $ cos+(* & - )3 P [/ $ #* $ #, $ cos+(* & . )]4
,
P + + $ #* $ #, $ %(, & * ) P + / $ #* $ #, $ %(, & * ) 1 $ 2+ P [/ $ #* $ #, %(. & * )]1
2
,
$ 4 P / $ #* , %(- & * )1 $ 3+ P $ #* $ #, $ %(* & , ) P + / $ #* $ #, $ %(* & , ) 2,
2
P +/ $ #* , %(* & - )3, ++P [/ $ #* $ #, %(* & . )]4, +
,
& $ #* $ #, $ 1 $ 2[%(* & , )] & + / $ #* , $ 1 $ 3[%(- & * )] & + / $ #* $ #, $ 1 $ 2[%(, & * )] & + / $ #*
2
$ #, $ 1 $ 4[%(. & * )] & / $ #* $ #, $ 1 $ 2 $ F* %, & + / $ #* $ #, $ 1 $ 4
$ (&B%* )F. & / $ #* $ #, $ 1 $ 4 $ F* %.
~ # #
&+ =
~G * *
* $ #* , ,
P + * P + , $ #* , P / $ #* , 1 P $ #* $ #, cos+(* & , ) P + / $ #* $ #, $ cos+(* & , ) 2+
4 2
P / $ #* , $ cos+(* & - )+3 P [5 $ #* $ #, $ cos+(* & . )]4
, ,
P + + $ #* $ #, $ %(, & * ) P + / $ #* $ #, $ %(, & * ) & $ #* $ #, [%(* & , )] & + / $ #* $ #,
2 2
$ %(, & * ) 1 $ 2+ P [5 $ #* $ #, %(. & * ) & + 5 $ #* $ #, %(. & * )]1 $ 4
~ # #
&+ = *
~G * *
* $ #*, 2
P + * P + , $ #* , P / $ #* , 1 P $ #1 $ #2cos+(1 & 2) P+5 $ #1 $ #2 $ cos+(1 & 2) 2 P 5 $ #1 2 $ cos+(1 & 3)+ 3
4 2
2
P [5 $ #1 $ #2 $ cos+(1 & 4)]4++ P $ #1 $ #2 $ %(1 & 2) P+5 $ #1 $ #2 $ %(1 & 2 ) 2,
2
P +/ $ #*,%(* & - )3, ++ P [/ $ #* $ #, %(* & .)]4,
4 $ y1 #* 4 $ y1 #* #*
=+& %* $ & B%* P + F* $ F* & * $ H $ F* & , $ H $ #* F*C * & / $ H#*F*
#*, 2 #* , 2 2
(3-80)
VARIABLE ARTICULAR
~ # #
&+ = ,
~G , ,
# 1 1
= $ , $ #* $ #, $ 1 $ 2 $ F* (&%, ) P $ , $ #* $ #, $ 1 $ 2 $ %* F, + P +2 $ #* $ #, $ 1 $ 2
, 2 2
$ F* (&%, ) P 2 $ #* $ #, $ 1 $ 2 $ %* F, P 2 $ #* $ #, $ 2 $ 3 $ (&%, )F- P 2 $ #*
$ #, $ 2 $ 3 $ F, %- P 2 $ #, , $ 2 $ 4 $ (&%, )F. P 2 $ #, , $ 2 $ 4 $ F, %.
# 1
= T $ , P 2W $ %(* & , ) #* $ #, $ 1 $ 2+ P 2 $ #* $ #, $ 2 $ 3 $ %(- & , ) P 2 $ #, , $ 2 $ 4 $ %(. & , )
, 2
# 1 1
= , $ #, , $ 2 P , $ 2 P $ , $ #* $ #, $ 1 $ F* F, P $ , $ #* $ #, $ 1 $ %* %, P 5 $ #* $ #, $ 1
, 2 2
$ F* F, P 5 $ #* $ #, $ 1 $ %* %, P 5 $ #* $ #, $ 3 $ F, F- P 5 $ #* $ #, $ 3
$ %, %- P #, , $ 5 $ 2 P 5 $ #, , $ 4 $ F, F. P 5 $ #, , $ 4 $ %, %.
~ # 1 1 1
= , $ #, , $ 2 P , $ 2 P $ , $ #* $ #, $ F* F, $ 1 P $ , $ #* $ #, $ (&%* )F, $ 1, P $ , $ #*
~G , 2 2 2
1 1
$ #, $ F* (&%, ) $ 1 $ 2 P $ , $ #* $ #, $ %* %, $ 1 P $ , $ #* $ #, $ F* %, $ 1,
2 2
1
P $ , $ #* $ #, $ %* F, $ 1 $ 2 P 5 $ #* $ #, $ F* F, $ 1 P 5 $ #* $ #, $ (&%* )F,
2
$ 1, P 5 $ #* $ #, $ F* (&%, ) $ 1 $ 2 P 5 $ #* $ #, $ %* %, $ 1 P 5 $ #* $ #,
$ F* %, $ 1, P 5 $ #* $ #, $ %* F, $ 1 $ 2 P 5 $ #* $ #, $ F, F- $ 3 P 5 $ #* $ #,
$ (&%, )F- $ 2 $ 3 P 5 $ #* $ #, $ F, (&%- ) $ 3, P 5 $ #* $ #, $ %, %- $ 3 P 5
$ #* $ #, $ F, %- $ 2 $ 3 P 5 $ #* $ #, $ %, F- $ 3, P #, , $ 5 $ 2 P 5 $ #, , $ F, F.
$ 4 P 5 $ #, , $ (&%, )F. $ 2 $ 4 P 5 $ #, , $ F, (&%. ) $ 4, P 5 $ #, , $ %, %. $ 4
P 5 $ #, , $ F, %. $ 2 $ 4 P 5 $ #, , $ %, F. $ 4,
~ # 1
= $ , $ #* $ #, $ F(* & ,) P / $ #* $ #, $ F(* & , ) 1 P , $ #,, P , P / $ #,, 2 P [/ $ #* $ #, $ F(, & - )]3
~G , 2
1
P / $ #,, $ F(, & .)4 P $ , $ #* $ #, $ %(, & *) P / $ #* $ #, $ %(, & *) 1,
2
1
P [/ $ #* $ #, $ %(, & -)]3, P [/ $ #, , $ %(, & .)]4, P [ $ , $ #* $ #, $ %(* & ,) P / $ %(*
2
& , )]1 $ 2 P [/ $ #* $ #, $ %(, & -)]2 $ 3+ P [/ $ #, , $ %(, & .)]2 $ 4
~ # # 1
&+ = $ , $ #* $ #, $ F(* & , ) P / $ #* $ #, $ F(* & , ) 1 P , $ #,, P , P / $ #,, 2
~G , , 2
P [/ $ #* $ #, $ F(, & -)]3 P / $ #,, $ F(, & .)4
1
P $ , $ #* $ #, $ %(, & *) P / $ #* $ #, $ %(, & *) 1, P [/ $ #* $ #, $ %(, & -)]3, P [/ $ #, ,
2
1 1
$ %(, & .)]4, P [ $ , $ #* $ #, $ %(* & ,) P / $ #* $ #, $ %(* & ,) & + T $ , P /W $ %(* & , )#*
2 2
$ #, ]1 $ 2 P [/ $ #* $ #, $ %(, & -) & / $ #* $ #, $ %(, & -)]2 $ 3+ P [/ $ #, , $ %(, & .) & / $ #,,
$ %(, & .)]2 $ 4
~ # #
&+ = ,
~G , ,
1
$ , $ #* $ #, $ F(* & ,) P / $ #* $ #, $ F(* & ,) 1 P , $ #, , P , P / $ #, ,2 P [/ $ #* $ #, $ F(, & -)]3
2
1
P / $ #,, $ F(, & .)4 P $ , $ #* $ #, $ %(, & *) P / $ #* $ #, $ %(, & *) 1,
2
#,
P [/ $ #* $ #, $ %(, & -)]3, P [/ $ #, , $ %(, & .)]4, = + &, $ H $ F, & / $ H $ #, F,
2
(3-82)
VARIABLE ARTICULAR
~ # #
&+ = -
~G - -
# 1 1
= $ # $ # $ 3 $ 4 $ (&%- )F. P . $ #* $ #, $ 3 $ 4 $ F- %. P / $ #* , $ 1 $ 3 $ F* (&%- )
- 2 . * , 2
P / $ #* , $ 1 $ 3 $ %* F- P / $ #* $ #, $ 2 $ 3 $ F, (&%- ) P 2 $ #* $ #, $ 2 $ 3
$ %, F- P / $ #* $ #, $ 3 $ 4 $ (&%- )F. P / $ #* $ #, $ 3 $ 4 $ F- %.
# 1
= $ %(. & - ) $ #* $ #, $ 3 $ 4 P / $ #* $ #, $ %(. & - ) $ 3 $ 4 P / $ #* , $ %(* & - ) $ 1 $ 3 P /
- 2 .
$ #* $ #, $ %(, & - ) $ 2 $ 3
# - $ #* , 1 1
= P + - 3 P . $ #* , $ 3 P . $ #* $ #, $ 4 $ F- F. P . $ #* $ #, $ 4 $ %- %. P / $ #* ,
- 4 2 2
$ 1 $ F* F- P / $ #* , $ 1 $ %* %- P + / $ #* , $ 3 P + / $ #* $ #, $ 2 $ F, F- P /
$ #* $ #, $ 2 $ %, %- P / $ #* $ #, $ 4 $ F- F. P / $ #* $ #, $ 4 $ %- %.
~ # - $ #*, 1 1 1
=+ P + - 3 P . $ #*, $ 3 P . $ #* $ #, $ F-F. $ 4 P . $ #* $ #, $ (&%-)F. $ 3 $ 4 P . $ #* $ #,
~G - 4 2 2 2
1 1 1
$ F-(&%.) $ 4, P . $ #* $ #, $ %- %. $ 4 P . $ #* $ #, $ F-%. $ 3 $ 4 P . $ #* $ #,
2 2 2
$ %-F. $ 4, P / $ #*, $ F*F- $ 1 P / $ #*, $ (&%*)F- $ 1, P / $ #* , $ F*(&%- ) $ 1
$ 3 P / $ #*, $ %*%- $ 1 P / $ #*, $ F*%- $ 1, P / $ #*, $ %*F- $ 1 $ 3 P + / $ #*, $ 3
P + / $ #* $ #, $ F, F- $ 2 P + / $ #* $ #, $ (&%, )F- $ 2, P + / $ #* $ #, $ F,(&%- ) $ 2 $ 3 P /
$ #* $ #, $ %,%- $ 2 P / $ #* $ #, $ F,%- $ 2, P / $ #* $ #, $ %, F- $ 2 $ 3 P / $ #* $ #,
$ F-F. $ 4 P / $ #* $ #, $ (&%- )F. $ 3 $ 4 P / $ #* $ #, $ F-(&%.) $ 4, P / $ #* $ #,
$ %-%. $ 4 P / $ #* $ #, $ F-%. $ 3 $ 4 P / $ #* $ #, $ %-F. $ 4,
~ # 3 $ #1 2 1
= [/ $ #* $ F(1 & 3 )]1 P [5 $ #1 $ #2 $ F(2 & 3 )]2 P [
,
P + 3 P 4 $ #1 2 P + 5 $ #1 2 ]3 P [ 4 $ #1 $ #2
~G - 4 2
$ F(3 & 4 ) P 5 $ #1 $ #2 $ F(3 & 4 )]4 P [5 $ #1 2 $ %(3 & 1 )]12 P [5 $ #1 $ #2 $ %(3 & 2 )]22
1
P [ 4 $ #1 $ #2 $ %(3 & 4 ) P 5 $ #1 $ #2 $ %(3 & 4 )]42 P [5 $ #1 2 %(1 & 3 )]1 $ 3 P [5 $ #1 $ #2
2
1
$ %(2 & 3 )]2 $ 3 P [ 4 $ #1 $ #2 $ %(4 & 3 ) P 5 $ #1 $ #2 $ %(4 & 3 )]3 $ 4
2
~ # # - $ #*, 1
&+ = + [/ $ #*, $ F(* & -)]1 P [/ $ #* $ #, $ F(, & - )]2 P [ P + - P . $ #* , P + / $ #*, ]3 P [ . $ #* $ #,
~G - - 4 2
$ F(- & .) P / $ #* $ #, $ F(- & .)]4 P [/ $ #*, $ %(- & *)]1, P [/ $ #* $ #, $ %(- & , )]2,
1
P [ . $ #* $ #, $ %(- & .) P / $ #* $ #, $ %(- & .)]4, P [/ $ #* , %(* & - )]1 $ 3 P [/ $ #* $ #,
2
1 1
$ %(, & -)]2 $ 3 P [ . $ #* $ #, $ %(. & -) P / $ #* $ #, $ %(. & - )]3 $ 4 & . $ %(. & - ) $ #*
2 2
$ #, $ 3 $ 4 & / $ #* $ #, $ %(. & -) $ 3 $ 4 & / $ #* , $ %(* & - ) $ 1 $ 3 & / $ #* $ #, $ %(, & -)
$ 2 $ 3+
~ # #
&+ = -
~G - -
- $ #* , 1
[/ $ #*, $ F(* & -)]1 P [/ $ #* $ #, $ F(, & -)]2 P [ P + - P . $ #*, P + / $ #* , ]3 P [ . $ #* $ #, $ F(- & .) P /
4 2
1
$ #* $ #, $ F(- & .)]4 P [/ $ #*, $ %(- & *)]1, P [/ $ #* $ #, $ %(- & ,)]2, P [ . $ #* $ #, $ %(-
2
& .) P / $ #* $ #, $ %(- & .)]4,
4 $ y3 #* 4 $ y3 #* #*
=& %- $ & B%- P + F- $ F- & - $ H $ F- & . $ H $ #*F- & / $ H $ #* F-
#*, 2 #*, 2 2
(3-83)
VARIABLE ARTICULAR
~ # #
&+ = .
~G . .
# 1 1
= $ # $ # $ 3 $ 4 $ F- (&%. ) P . $ #* $ #, $ 3 $ 4 $ %- F. P / $ #* $ #, $ 1 $ 4
. 2 . * , 2
$ F* (&%. ) P / $ #* $ #, $ 1 $ 4 $ %* F. P / $ #* $ #, $ 3 $ 4 $ F- (&%. ) P /
$ #* $ #, $ 3 $ 4 $ %- F. P / $ #, , $ 2 $ 4 $ F, (&%. ) P / $ #, , $ 2 $ 4 $ %, F.
# 1
= $ . $ #* $ #, $ %(- & . ) $ 3 $ 4 P / $ #* $ #, $ %(* & . ) $ 1 $ 4 P / $ #* $ #, $ %(- & . ) $ 3 $ 4
. 2
P / $ #, , $ %(, & . ) $ 2 $ 4
# 1 1
= . $ #, , $ 4 P . $ #* $ #, $ 3 $ F- F. P . $ #* $ #, $ 3 $ %- %. P . $ 4 P / $ #* $ #, $ 1
. 2 2
$ F* F. P / $ #* $ #, $ 1 $ %* %. P / $ #* $ #, $ 3 $ F- F. P / $ #* $ #, $ 3
$ %- %. P / $ #, , $ 2 $ F, F. P / $ #, , $ 2 $ %, %. P + / $ #, , $ 4
~ # 1 1 1
= + . $ #, , $ 4 P . $ #* $ #, $ F- F. $ 3 P . $ #* $ #, $ (&%- )F. $ 3, P . $ #* $ #,
~G . 2 2 2
1 1 1
$ F- (&%. ) $ 3 $ 4 P . $ #* $ #, $ %- %. $ 3 P . $ #* $ #, $ F- %. $ 3, P .
2 2 2
$ #* $ #, $ %- F. $ 3 $ 4 P . $ 4 P / $ #* $ #, $ F* F. $ 1 P / $ #* $ #, $ (&%* )F.
$ 1, P / $ #* $ #, $ F* (&%. ) $ 1 $ 4 P / $ #* $ #, $ %* %. $ 1 P / $ #* $ #,
$ F* %. $ 1, P / $ #* $ #, $ %* F. $ 1 $ 4 P / $ #* $ #, $ F- F. $ 3 P / $ #* $ #,
$ (&%- )F. $ 3, P / $ #* $ #, $ F- (&%. ) $ 3 $ 4 P / $ #* $ #, $ %- %. $ 3 P /
$ #* $ #, $ F- %. $ 3, P / $ #* $ #, $ %- F. $ 3 $ 4 P / $ #, , $ F, F. $ 2 P /
$ #, , $ (&%, )F. $ 2, P / $ #, , $ F, (&%. ) $ 2 $ 4 P / $ #, , $ %, %. $ 2 P /
$ #, , $ F, %. $ 2, P / $ #, , $ %, F. $ 2 $ 4 P + / $ #, , $ 4
~ #
= / $ #* $ #, $ F(1 & 4 )1 P / $ #, , $ F(2 & 4 )2
~G .
1
P . $ #* $ #, $ F(3 & 4 ) P / $ #* $ #, $ F(3 & 4 ) 3 P . $ #, , P . P + / $ #, , 4
2
P / $ #* $ #, $ %(4 & 1 )1, P / $ #, , $ %(4 & 2 )2,
1
P . $ #* $ #, $ %(4 & 3 ) P + / $ #* $ #, $ %(4 & 3 ) 3, P / $ #* $ #, $ %(1 & 4 )1 $ 4
2
1
P / $ #, , $ %(2 & 4 )2 $ 4 P [ . $ #* $ #, $ %(3 & 4 ) P / $ #* $ #, $ %(3 & 4 )]3 $ 4+
2
~ # #
&+ = / $ #* $ #, $ F(1 & 4 )1 P / $ #, , $ F(2 & 4 )2
~G . .
1
P . $ #* $ #, $ F(3 & 4 ) P / $ #* $ #, $ F(3 & 4 ) 3 P . $ #, , P . P + / $ #, , 4
2
P / $ #* $ #, $ %(4 & 1 )1, P / $ #, , $ %(4 & 2 )2,
1
P . $ #* $ #, $ %(4 & 3 ) P + / $ #* $ #, $ %(4 & 3 ) 3, P / $ #* $ #, $ %(1 & 4 )1 $ 4
2
1
P / $ #, , $ %(2 & 4 )2 $ 4 P [ . $ #* $ #, $ %(3 & 4 ) P / $ #* $ #, $ %(3 & 4 )]3 $ 4+
2
1
& + $ . $ #* $ #, $ %(- & . ) $ 3 $ 4 & / $ #* $ #, $ %(* & . ) $ 1 $ 4 & / $ #* $ #,
2
$ %(- & . ) $ 3 $ 4 & / $ #, , $ %(, & . ) $ 2 $ 4
~ # #
&+ = .
~G . .
1
[/ $ #* $ #, $ F(* & . )]1 P / $ #, , $ F(, & . )2 P . $ #* $ #, $ F(- & . ) P / $ #* $ #, $ F(- & . ) 3
2
P . $ #, , P . P + / $ #, , 4 P [/ $ #* $ #, $ %(. & * )]1, P / $ #, , $ %(. & , )2,
1
P . $ #* $ #, $ %(. & - ) P + / $ #* $ #, $ %(. & - ) 3,
2
#,
= &. $ H $ F. & / $ H $ #, F.
2
ANEXO 4
SIMULACIN DE POSICIN
ROBOT PARALELO
Preparar el Algoritmo
>
>
Cargar Newton-Rhapson
>
>
>
>
Ecuaciones de Posicin
Par de Revolucin en A
Se determina la siguiente ecuacin:
>
>
>
>
>
>
Par de Revolucin en B
>
>
>
>
>
Par de Revolucin en C
>
>
>
>
>
>
Par de Revolucin en D
>
>
>
>
>
>
Par de Revolucin en E
>
>
>
>
>
Par de Revolucin en F
>
>
>
>
>
>
Ecuaciones de Restriccin
>
>
>
>
>
>
>
>
>
>
>
>
>
Matriz de Restricciones
>
Modelacin
Variables Independientes
>
>
Jacobiano
Dependiente
>
>
>
>
Independiente
>
>
>
Evaluacin
>
>
>
>
>
ANEXO 5
SIMULACIN DE VELOCIDAD
Preparar el Algoritmo
>
>
Cargar Newton-Rhapson
>
>
>
>
Par de Revolucin en A
>
>
>
>
>
>
Par de Revolucin en B
>
>
>
>
>
>
>
>
Par de Revolucin en C
>
>
>
>
>
>
>
>
Par de Revolucin en D
>
>
>
>
>
>
>
Par de Revolucin en E
>
>
>
>
>
>
>
>
Par de Revolucin en F
>
>
>
>
>
>
Ecuaciones de Restriccin
>
>
>
>
>
>
>
>
>
>
>
>
>
Matriz de Restricciones
Modelacin y Simulacin
Variables Independientes
>
>
Jacobiano
Dependiente
>
>
>
Independiente
>
>
Evaluacin
>
>
>
>
>
ANEXO 6
SIMULACIN DE ACELERACIN
Preparar el Algoritmo
>
>
Cargar Newton-Rhapson
>
>
>
>
Par de Revolucin en A
>
>
>
>
>
>
>
>
>
Par de Revolucin en B
>
>
>
>
>
>
>
>
>
>
>
Par de Revolucin en C
>
>
>
>
>
>
>
>
>
>
>
Par de Revolucin en D
>
>
>
>
>
>
>
>
>
>
Par de Revolucin en E
Se determina la siguiente ecuacin la cual derivamos, donde q representa que el
vector ha sido derivado 2 vez
>
>
>
>
>
>
>
>
>
>
>
Par de Revolucin en F
>
>
>
>
>
>
>
>
Ecuaciones de Restriccin
>
>
>
>
>
>
>
>
>
>
>
>
>
Matriz de Restricciones
>
Simulacin
Variables Independientes
>
Jacobiano
Dependiente
>
>
>
>
>
Independiente
>
>
>
Evaluacin
>
>
>
>
>
ANEXO 7
PLANOS