PPR
PPR
PPR
POSICIONAMIENTO DE PIEZAS
UNIVERSIDAD DE LA SALLE
FACULTAD DE INGENIERA DE DISEO Y AUTOMATIZACIN ELECTRNICA
BOGOT D.C.
2007
Trabajo de grado presentado como requisito para optar por el ttulo de Ingeniero
de Diseo y Automatizacin Electrnica
UNIVERSIDAD DE LA SALLE
FACULTAD DE INGENIERA DE DISEO Y AUTOMATIZACIN ELECTRNICA
BOGOT D.C.
2007
NOTA DE ACEPTACIN
___________________________
___________________________
___________________________
Ing. Jaime Humberto Carvajal
Director
__________________________
Ing. Jairo Montoya
Jurado
___________________________
Ing. Pedro Emilio Prieto
Jurado
AGRADECIMIENTOS
TABLA DE CONTENIDO
Pg.
LISTA DE FIGURAS
VII
LISTA DE TABLAS
VIII
LISTA DE ECUACIONES
IX
LISTA DE ANEXOS
GLOSARIO
XI
13
14
2.1. PROBLEMA
2.2. ANTECEDENTES
2.3. OBJETIVOS
2.3.1. General
2.3.2. Especficos
15
15
16
16
16
3. MARCO TERICO
17
20
20
22
23
25
27
28
29
30
30
31
32
33
35
36
6. CINEMTICA INVERSA
41
41
47
47
52
52
53
54
55
56
57
59
59
61
62
63
63
68
69
71
72
74
74
75
77
12. BIBLIOGRAFA
80
vi
LISTA DE FIGURAS
Pg.
17
27
27
29
34
38
41
48
65
66
67
54
56
vii
LISTA DE TABLAS
Pg.
Tabla 1. Clasificacin de los robots segn La Asociacin Francesa
de Robtica Industrial (AFRI).
14
18
20
22
viii
LISTA DE ECUACIONES
ix
LISTA DE ANEXOS
Pg.
ANEXO A. COMPROBACIN MATEMTICA DE LA CINEMTICA DIRECTA DEL ROBOT
81
84
90
92
95
99
103
108
112
117
119
GLOSARIO
Holgura: Espacio que queda entre dos piezas que han de encajar una en otra
Movimiento lineal: Se denomina movimiento lineal, aqul cuya trayectoria es una lnea
recta.
Movimiento rotacional
Rozamiento: Se define como fuerza entre dos superficies cuando estan en contacto
xi
xii
de un robot
13
2.1. PROBLEMA
antes de
realizar la venta, por tal motivo, es necesario tener dentro del C.I.M un mdulo que
se encargue de realizar esta tarea. Si el sistema esta completamente
automatizado es conveniente que el proceso de almacenaje tambin lo sea, esto
con el fin de evitar retardos. En el actual laboratorio no se cuenta con una estacin
de almacenaje, el sistema de banda transportadora no deposita el producto en
ningn lado y este regresa al inicio del proceso completamente ensamblado, por
tal motivo es indispensable el diseo e implementacin del mdulo de
almacenamiento totalmente automatizado, en el cual se encuentre un robot capaz
de identificar los diferentes tipos de producto y ubicarlos en el lugar adecuado. En
el presente trabajo se dar la solucin diseando y modelando un robot que
integre la celda flexible de sistema AS/RS del laboratorio de robtica.
14
2.2. ANTECEDENTES
15
2.3. OBJETIVOS
2.3.1. General
Disear y modelar un robot cartesiano para el posicionamiento de piezas para el
modulo de almacenamiento en el laboratorio de automatizacin y robtica.
2.3.2. Especficos
16
3. MARCO TEORICO
17
automtico o
TIPO
A
CARACTERSTICA
Manipulador con control manual o telemando
Manipulador automtico con ciclos prefijados; regulacin mediante fines de
18
La
Estructura mecnica.
Transmisiones y Reducciones.
Sistemas de accionamiento.
Sistema sensorial.
Sistema de control.
Elementos terminales
19
aproximado a un cilindro.
La configuracin cartesiana mostrada en la figura 1 c) permite que cada una de
sus articulaciones se deslice en lnea recta a travs de los ejes de coordenadas
xyz, esta configuracin forma un poliedro en su espacio de trabajo.
Figura 1. Configuraciones tpicas de los robots industriales
20
3.1. 2. Transmisiones.
Los sistemas de transmisin bsicamente son el conjunto de dispositivos que se
encargan de entregar la potencia generada por los actuadores a los elementos o
articulaciones del robot. Teniendo en cuenta el tipo de operacin que va a realizar
el robot, se debe determinar que transmisin es la correcta a utilizar.
Principalmente los sistemas de transmisin se encargan de reducir la velocidad
generada por los motores con el fin de disminuir la inercia en los extremos del
robot. Por otra parte, tambin son utilizados los sistemas de transmisin para
convertir movimientos circulares en lineales. Algunos de los sistemas de
transmisin tpicos utilizados en los robots industriales son los que se presentan
en la tabla 2, all se encuentra la entrada al sistema y la salida que se obtienen
segn el sistema de transmisin, tambin se muestran las ventajas y desventajas
del sistema.
21
ENTRADA/SALIDA DENOMINACIN
Circular/Circular
Circular/Lineal
Lineal/circular
VENTAJAS
Engranaje
Pares altos
Correa dentada
Distancia grande
Cadena
Distancia grande
DESVENTAJAS
Holguras
Ruido
Paralelogramo
Giro limitado
Cable
Deformabilidad
Poca holgura
Rozamiento
Cremallera
Holgura media
Rozamiento
Paral articulado
Cremallera
Control difcil
Holgura media
Rozamiento
dinmico. Estos pueden determinar el tipo de aplicacin que puede tener el robot.
Para seleccionar el actuador adecuado se debe tener en cuenta el tipo de energa
que utiliza, adems de otros factores tales como: potencia, controlabilidad, peso y
volumen, precisin, velocidad, mantenimiento y costo.
De acuerdo al tipo de energa existen:
22
o Corriente alterna
Sncronos
Asncronos
o Paso a paso
En la tabla 3, se pueden observar las ventajas y desventajas de cada uno de las
actuadores mencionados anteriormente.
23
Energa
Opciones
Ventajas
Neumtico
Aire a presin
(5-10 bar)
Cilindro
Motores de
pales
Motores pistn
Hidrulico
Aceite mineral
(50 100 bar)
Cilindro
Motores de pales
Motores pistn
Rpidos
Alta relacin
peso/potencia
Auto lubricantes
Alta capacidad de
carga
Estabilidad frente a
cargas estticas
Difcil mantenimiento
Instalacin especial
Frecuentes fugas
Costosos
Econmicos
Sencillos
Rpidos
Robustos
Elctrico
Corriente
elctrica
Corriente
continua
Corriente
alterna
Motor paso a
paso
Precisos
Fiables
Fcil control
Sencilla
instalacin
Silenciosos
Potencia
limitada
24
actuadores; estos sensores al igual que los de posicin son utilizados como
dispositivos de realimentacin. Los sensores de posicin proporcionan los
medios necesarios para determinar si las articulaciones se desplazaron o
no ubicando la posicin en que se encuentra dentro del espacio de trabajo
el robot rectificando la posicin y encontrando las correcta ubicacin del
efector final. Entre los ms usados se encuentran los potencimetros,
encoder, resolver, entre otros. Los sensores de presencia son los
encargados de delimitar los movimientos de las articulaciones y detectan la
presencia de un objeto; los tipos de sensores mas utilizados son los
inductivos, efecto hall, clula red, pticos, ultrasnicos, de contacto.
En la tabla 4 se pueden observar los diferentes tipos de sensores mas utilizados
en robtica.
Tabla 4. Tipos de sensores internos de los robots.
Presencia
Posicin
Inductivo
Capacitivo
Efecto Hall
Clula Reed
Ultrasnico
Contacto
Analgicos
Digtales
Velocidad
Potencimetros
Resolver
Sincro
Inductivos
LVDT
Encoders Absolutos
Encoder Incrementales
Regla ptica
Tacogenerador
Fuente: Fundamentos de Robtica. Barrientos
25
dedos son los cilindros neumticos y cilindros hidrulicos, los motores paso a paso
y servo motores. En las transmisiones para el movimiento del mecanismo de los
dedos se usan elementos rgidos y flexibles. Los sensores son utilizados cuando
se necesita controlar algn tipo de presin. El controlador se encuentra integrado
al control central y es encarga de coordinar el cierre y apertura de los dedos.
Los dedos son los encargados de sujetar la pieza por el rea externa o por el rea
interna, si tiene un agujero. Deben capturar la pieza con suficiente presin para
vencer la fuerza de gravedad y tener una superficie spera para que no resbale la
pieza a sujetar. (Carvajal. 2007).
26
27
28
POM ( x, y, z )
Coordenadas cilndricas. El vector que la representa es el siguiente.
POM (r ,, z )
Coordenadas esfricas. El vector que la representa es el siguiente.
POM (r ,, )
29
Pxyz = px , py , pz = px ix + py jy + pz kz
T
Puvw =[ pu , pv , pw ] = pu iu + pv jv + pw kw
T
(1.0)
30
(2.0)
ixiu
R = j y iu
k z iu
ix k w
j y k w
k z k w
ix jv
j y jv
k z jv
(3.0)
R es la matriz de rotacin que define la orientacin del sistema ouvw con respecto
al sistema oxyz, esta matriz es ortogonal y por lo tanto la inversa R-1 es igual a la
traspuesta RT.
R-1 =RT
sin
cos
(4.0)
0 sin
1
0
0 cos
(5.0)
cos sin
R ( z , ) = sin 0 cos
0
0
0
0
1
(6.0)
31
R
T = 33
f13
P31
w11
(7.0)
1
0
T =
0
0 Px
0 Py
1 Pz
0 1
0
1
0
0
(8.0)
rx 1
r 0
y =
rz 0
1 0
0
1
0
0
0 Px ru
0 Py rv
1 Pz rw
0 1 1
32
(9.0)
33
Fuente: Autores
34
35
(Carvajal. 2007)
36
Fuente: Autores
Una vez determinados los marcos de los elementos, la posicin y orientacin de
cada uno de ellos, es posible establecer los parmetros (Carvajal 2007):
i : Angulo entre los ejes Zi-1 y Zi alrededor del eje Xi, puede tomarse positivo
cuando la rotacin se hace en sentido horario
i : Angulo entre los ejes Xi-1 y Xi alrededor de Zi-1, puede tomarse positivo
cuando la rotacin se hace en sentido horario
di : Coordenada de Oi a lo largo de Zi-1
ai : Distancia entre Oi y Oi a lo largo de Xi-1
De acuerdo con los anteriores parmetros y teniendo en cuenta la figura 5 se
encuentran los parmetros Denavit-Hartenberg que representan la cinemtica
del robot:
37
Parmetros Denavit-Hartenberg
Eslabn i
di
ai
90
90
d1
90 -90 d2
d3
Aii 1
cos i
sin
i
=
0
cos i sin i
cos i cos i
sin i
0
0
1
0
A1 =
0
0
0
1
0
0
1
1
A2 =
0
0
1
0
A32 =
0
0
1
0
0
sin i sin i
sin i cos i
cos i
0
ai cos i
ai sin i
di
(10.0)
1 0
0 0
0 d1
0 1
(11.0)
0 1 0
0 0 0
1 0 d2
0 0 1
(12.0)
0 0
0 0
1 d3
0 1
(13.0)
38
(14.0)
0
0
T =
1
1
0
0
1
0
0
0
0
d2
d 3
d1
(14.1)
39
6. CINEMTICA INVERSA
La cinemtica inversa busca encontrar los valores que tienen que tomar las
articulaciones del robot para que su elemento final se encuentre en una posicin y
orientacin dada. La metodologa para resolver este problema a partir de la matriz
de transformacin homognea se describe a continuacin:
siguiente matriz
(A )
i 1 1
i
nx
n
= y
nz
sx
sy
sz
ax
ay
az
nT Px
s T Py
a t Pz
(15.0)
Por lo tanto
(A10 )1 = 10
1
0
0
0
0 0
1 0
0 d1
0 1
(15.1)
0
0
=
1
1
0
0
0
0
0
1
0
0 d2
0
1
(15.2)
(A )
1 1
2
40
(A )
2 1
3
1
0
=
0
0
0
0
0
1 d3
0 1
0
1
0
0
(15.3)
(A )
0 1
1
T = A21 A32
(A ) (A )
0 1
1
1 1
2
T = A32
(14.2)
(14.3)
Debido a que la configuracin del robot es cartesiana esta no presenta alto grado
de complejidad para determinar la cinemtica inversa, simplemente es necesario
saber cuales son las coordenadas en el plano cartesiano en las cuales se
encuentra ubicado el objeto y con estos valores se determina que distancia se
debe desplazar cada uno de los eslabones.
41
d L L
=
dt q q
(16.0)
L=K P
(17.0)
Donde
L= Representa el Lagrangiano y es la diferencia entre la energa cintica y la
energa potencial.
K= Energa cintica del robot.
42
Fuente: Autores
De acuerdo con la figura 6 y desarrollando la formulacin de Lagrange-Euler se
obtiene lo siguiente:
2
1
K 1 = (m1 + m2 ) d1
2
(18.0)
P1 = 0
(19.0)
2
1
K 2 = m2 d 3
2
(20.0)
P2 = m2 gd 2
(21.0)
43
(22.0)
2
2
1
1
L = (m1 + m2 ) d1 + m2 d3 0 + m2 gd 2
2
Aplicando la ecuacin
(23.0)
d1
= (m1 + m2 ) d1
d L
=
(
+
)
m
m
d
1
2
1
dt d
1
L
=0
d1
F1 = (m1 + m2 ) d1
L
(23.1)
=0
d 21
d L
=0
dt d
2
L
= m2 g
d 2
F2 = m2 g
L
d
d
dt
= m
(23.2)
L
d
= m
L
= 0
d 3
F3 = m2 d 3
44
(23.3)
F1 (m1 + m2 ) d1
F =
0
2
F3
0
0
m2 g
0
0
0
m2 d 3
(24.0)
Una vez obtenida la matriz que representa el modelo dinmico del robot, se
reemplazaran sus valores correspondientes para determinar la fuerza requerida
para movilizar cada uno de los eslabones.
0
F1 (m1 + m2 ) d1
F =
0
m2 g
2
F3
0
0
0
0
m2 d 3
Donde
m1 es la masa del eslabn 2 (es la suma del conjunto del tornillo junto con la
carcasa) es decir:
m1 1,034 Kg + 0.4 Kg
m1 = 1.434 Kg
m2 es la masa del eslabn 3 junto con la carga que se va a transportar, es decir:
45
0
0
F1 (1.43 + 3.37)9,8
F =
0
3.37 9.8
0
2
F3
0
0
3.37 0.2
F1 47.04 N
F = 33.026 N
2
F3 0.674 N
46
El robot consta 3 grados de libertad, en le eje X se encuentran dos guas por las
cuales se desplazara el eslabn vertical. La transmisin del movimiento en el eje X
se realiza utilizando una correa dentada. Para el desplazamiento en el eje Z se
dispondr de un tornillo de bolas y dos guas. El desplazamiento en el eje Y se
realiza utilizando como actuador un cilindro neumtico.
El material usado para la estructura es aluminio ya que este posee una buena
resistencia mecnica, alta resistencia a la corrosin y poco peso. Adicionalmente
el aluminio es un material de bajo costo y fcil de encontrar en el mercado. El tipo
de aluminio utilizado es una aleacin 6061-T6 ya que esta aleacin es la utilizada
para la fabricacin de perfiles.
El primer eslabn se encuentra en el eje X (eslabn 1), y esta compuesto por dos
ejes paralelos sobre los cuales se desliza el vagn que sostiene el eslabn
vertical, los dos ejes estas sujetos en cada uno de sus extremos por un soporte
en aluminio,
47
Fuente: Autores
El eslabn vertical (eslabn 2) se encuentra unido en la parte superior al vagn
del eslabn 1, este consta de un perfil rectangular hueco en el centro, esto con el
fin de reducir el peso de la estructura, permitir la ubicacin de los sistemas de
transmisin, los cables y los elementos electrnicos del robot. En el centro del
perfil se encuentra un tornillo que transforma el movimiento rotacional a lineal del
eslabn 3.
El eslabn 3 es un cilindro neumtico, este se une al eslabn 2 en la tuerca del
tornillo.
48
Fuente: Autores
El rack en donde se almacenan las piezas se ubica en la parte exterior de la
banda las dimensiones de este se muestran en la figura El robot ubica los palets
en cada uno de los orificios del rack, por cada orificio se pueden introducir dos
bandejas. De acuerdo con las dimensiones del rack se establecen las distancias
mximas de desplazamiento para cada uno de los eslabones.
49
xt = x d + x f
Ecuacin 25. Tiempo total de proceso de fabricacion
Donde:
xt= tiempo total de proceso
xd=tiempo de desplazamiento ddesde el modulo de alimentacin hasta el modulo
de procesos
xf=tiempo de fabricacin
Si se calcula que le tiempo de desplazamiento en la banda es de 2 minutos y el
tiempo estimado en el proceso de fabricacin es de 6 minutos, reemplazando
estos valores en la ecuacin 25 se obtiene:
xt = 2 + 6
xt = 8 min
Obtencin de tiempo de Proceso de Fabricacin
50
m
V
(26.0)
Donde:
m = V
mP = (0,00270Kg/ cm3)(382,80 cm3)
mP 1,034 Kg
El peso de la bandeja junto con la pieza con mayor peso que ser transportada es
de aproximadamente 420g y el peso del cilindro es de 2600g, el peso de la
herramienta es de aproximadamente 350g.
mB =0.42Kg (masa de la bandeja junto con la pieza de mayor peso)
mC= 2.6Kg (masa del cilindro)
mH = 0.35Kg (masa de la herramienta)
51
a aceleracin (m/s2)
b ancho de la banda (mm)
Cs Factor de seguridad (adimensional)
d1 dimetro piones de transmisin
Fu Fuerza perifrica (N)
Fp space Fuerza transmisible por diente por ancho (N/cm)
52
Fu = (m a) + (m g )
Ecuacin 27. Clculo de la Fuerza Perifrica
Donde se puede determina de acuerdo con anexo B, en el cual se observa que
si la banda se encuentra en contacto con una superficie en aluminio su coeficiente
de friccin es:
= 0.8
a = 0.2m/s2
m = mMT = 14.662 Kg
53
b=
Fu C s 10
F p space Z m
Donde los valores Cs, Fp space , Zm se encuentran en las tablas del anexo C
Cs =2
Para determinar el Fp space es necesario identificar que tipo de correa se requiere;
(Ver anexo C); para una carga de 117.9N se selecciona la correa T5. Para
determinar el pin adecuado se tiene en cuenta la velocidad de entrada (motor
eslabn 1), y la velocidad de la correa. El dimetro del pin utilizado es de 40mm,
la velocidad de entrada que se requiere para realizar el movimiento lineal a una
velocidad de 0.2m/s es de 95.5 RPM, su obtencin se explicara en el seleccin del
motor eslabn 1.
Para esta velocidad la fuerza transmisible por diente por ancho (Fp
space)
corresponde a:
Fp
space
=22 (N/cm)
54
Z m = Z 1 180 / 360
Z m = 12.5
Z m = 12
Con los valores hallados anteriormente se calcula en ancho de la correa de
acuerdo a la ecuacin 27.0
117.9 2 10
22 12
b = 8.9mm
b=
Carga: Para determinar esta carga total se suma la carga de la bandeja junto
con la pieza de mayor peso, el peso del cilindro, el peso de la herramienta y el
peso aproximado del la tuerca del tornillo. Esto se realiza utilizando la ecuacin
29.
55
mTuerca= 0.037 Kg
mT =0.4Kg (masa total del tornillo junto con la tuerca)
m M = mtuerca + m B + mC + m H
Ecuacin 29. Clculo de la Carga Mxima
Para este diseo se utiliza un factor de seguridad de 4 esto con el fin de evitar
sub-dimensionar el sistema y que los requerimientos de cargas y capacidad del
robot sean limitados (Carvajal. 2007)
Por lo tanto se tiene que la carga es:
m MT = m M * FS
FS = 4
m MT = 3.407 4
m MT = 13.628 Kg
En unidades del sistema ingles
m MT = 30.05lb
56
P
X = r
Pt
* 1,000,000in
Donde:
Pr=Carga axial
Pt= Carga Dinmica
Por lo tanto
3
P
13452000 = r * 1,000,000in
30.05
Pr = 3
13452000
3
(30.05)
1,000,000
Pr = 71.5lbs
De acuerdo a la carga anteriormente hallada se selecciona un tornillo de la
marca rockfordballscrew de referencia RH R-16-1 (ver anexo C).
57
n1 =
V 19100
d1
Donde:
V=0.2m/s
d1=40mm (dimetro del pin).
Reemplazando los valores anteriores en la ecuacin 31 se obtiene la velocidad
requerida para el motor del eslabn 1:
0.2 19100
40
n1 = 95.5 RPM
n1 =
58
Td 1 =
Fu d 1
2000
P=
Td 1 n1
9550
2.4 95.5
9550
P = 23.6W
P=
59
RPM =
velocidad
avance
Reemplazando se obtiene:
472.4 pu lg/ min
0.125 pu lg/ rev
RPM = 3779.52
RPM =
El clculo del torque necesario para movilizar la tuerca del tornillo junto con el
cilindro, el palet y la pieza de mayor peso, se obtiene utilizando la ecuacin 35.
Td 2 =
S I * ( Pt )
2Eff
Donde
Pt = Carga =30.05lbs
Eff =Eficiencia. (Para el caso de los tornillos de bolas la eficiencia de estos es del
90%).
60
0.125 * 30.05
2 0.9
1.9212
=
5.652
= 0.7lbs. pu lg
Td 2 =
Td 2
Td 2
El torque necesario para mover el tornillo con su carga total a una velocidad
constante es de 0.1Nm (0.7lbs.pulg.).
El clculo de la potencia se realiza con velocidad constante y se obtiene utilizando
la ecuacin 36.
H .P =
RPM * Td
63,000
3779.52 * 0.7
63,000
H .P = 0.04 HP / min
H .P =
61
62
Despejando A
A = 360x/p
Para obtener el nmero de pulsos que necesita el motor para llegar a una
distancia x se utiliza la ecuacin 39.
np = 360x/p
Ecuacin 39. Nmero de pulsos para recorrer un distancia.
63
F = m g
Ecuacin 40. Fuerza Requerida para el Cilindro
Donde:
m= 1.925Kg.
g=9.8m/s
Reemplazando los valores anteriores en la ecuacin 36 se obtiene:
F = (1.925 Kg )(9.8m / s )
F = 19 N
64
D2 P R
F =
4
Despejando:
D=
F 4
PR
Donde:
F = Fuerza >Requerida (N)
D = Dimetro del cilindro (mm)
P = Presin de trabajo (bar)
R = Rendimiento del cilindro (se estima en 0.85 para cilindros menores a 40 mm)
Reemplazando se obtiene:
19 4
6bar 0.85
D = 7mm
D=
D = 7mm 4
D = 28mm
65
El fabricante del cilindro, Festo recomienda que para una carrera de 400mm el
dimetro del mbolo es de 40mm por tal motivo se selecciona un cilindro con este
dimetro de mbolo (Ver anexo E).
Para calcular la fuerza de avance se utiliza la ecuacin 37 y remplazando los
valores obtenidos se calcula la fuerza.
( 40mm) 2 6 0.85
F =
4
F = 640.9 N
(D2 d 2 ) P R
F =
4
66
(2 D 2 d 2 ) C P
V =
4
Donde:
V = Volumen de aire (mm3)
D= Dimetro del cilindro (mm)
d = Dimetro del vstago (mm)
C = Carrera del vstago (mm)
Reemplazando:
((
V =
4
3
V = 5.6mm
Obtencin Consumo de Aire Mximo
67
9. DISEOS ELECTRNICO.
Como se explico en el capitulo anterior los motores a utilizar son motores paso a
paso, su alimentacin es de 48V DC, para los motores paso a paso se debe
diseara un circuito que controle la cantidad de pulsos que se le entregan al motor
para que este gire a la posicin deseada, un circuito de control bsico para un
motor paso a paso se muestra en la figura 9, este circuito consta de un puente H
Figura 9. Circuito Bsico para un Motor Paso a Paso Bipolar
Fuente: http://www.todorobot.com.ar/informacion/informacion.htm
68
69
Fuente: Autores
Sin embargo el circuito anterior no tiene gran prediccin ya que los componentes
utilizados son dispositivos del mercado y por ende son muy bajas, por tal motivo el
controlador que se ajusta a las necesidades del diseo es el controlador para
motores paso a paso de Festo tipo SEC-ST-48-6-P01, este controlador tiene
varias entradas las cuales permite enviar seales desde un PLC (controlado lgico
programable) ya que integra los motores en un proceso de trabajo junto con un
procesador central, permite variar la velocidad del motor, controlar los voltajes de
salida al motor al igual que su corriente, adems, por medio de entradas digitales,
puede realizarse el control con respecto al nmero de pasos y el sentido utilizando
el microcontrolador mostrado en la figura 10.
Las caractersticas generales del controlador SEC-ST-48-6-P01 se observan en el
(anexo F).
70
Fuente : http://www.x-robotics.com/.
En estado de reposo la pata comn (C) y la de reposo (R) estn en contacto
permanente hasta que la presin aplicada a la palanca del bumper hace saltar una
pletina acerada que se encuentra en el interior del bumper al hacer contacto pasa
de la posicin de reposo a la de activo (A), esto sucede casi al final del recorrido
de la palanca. Dando paso o eliminando la corriente segn la configuracin del
circuito. En el diseo del circuito se adapto este sensor para que una vez
accionado permita le paso de la corriente y genere una cada de tensin en la
entrada del microcontrolador y el programa se encarga de enviar una seal al
controlador para que detenga el motor. Ver figura 10.
71
La tarea final que desempeara el robot es la de movilizar los palets junto con las
piezas terminadas y ubicarlos en le rack, esta mueca presenta un grado de
libertad, su movimiento es rotacional y lo realiza alrededor del eje z.
Fuente: Autores
72
Para el clculo de la fuerza requerida se utiliza la ecuacin 36; las masa que debe
mover este motor es de 0.42 Kg (masa del conjunto bandeja pieza) mas la masa
aproximada de la pinza 0.35Kg
Por lo tanto utilizando la ecuacin 40 se obtiene:
m EF = m B + m P
Ecuacin 44. Masa Total para Mover por la Mueca
Dende:
mEF= Masa total
mB= 0.42Kg
mP= 0.35Kg
Reemplazando:
m EF = 0.42 + 0.35
m EF = 0.77 Kg
Obtencin Masa Total para Mover por la Mueca
P=
m EF v
Donde:
v=velocidad
=rendimiento del motor (se considera la eficiencia del motor en 0.85)
73
Reemplazando:
0.77 0.2
0.85
P = 1.8W
P=
n1 =
Td 3 =
P 9550
n1
1.8 10 3 * 9550
191
= 9.2 10 3 Nm
Td 3 =
Td 3
74
FG =
m ( g + a)
sin S
2
Donde,
FG= Fuerza de sujecin (N)
m= masa de la pieza (Kg)
g=gravedad (9.8m/s2)
75
reemplazando se obtiene:
0.42 (9.8 + 0.2)
sin 45 2.5
2 0.49
FG = 7.5 N
FG =
Esta es la fuerza de sujecin por dedo, es decir que la fuerza total de sujecin
debe ser de 15N mnimo, la pinza que se ajusta a estas caractersticas es la pinza
HGP 06 A de Festo (ver anexo G).
Para la seleccin del elemento final se utilizo el software Festo para la seleccin
de Pinzas. En el anexo I se observa la metodologa y los resultados obtenidos de
la seleccin.
76
77
78
12. BIBLIOGRAFA
APARICIO GONZLEZ MARCELA, ORJUELA PARRA JOHANNA. Control Para
Un Brazo Robot Colocado Sobre Una Plataforma Mvil RSULA. Proyecto de
Grado. Pontificia Universidad Javeriana. Facultad de Ingeniera. Carrera Ingeniera
Electrnica. Bogot. 2005, 132p
79
80
Anexo A
Comprobacin
matemtica de la
cinemtica directa del
robot
81
0
0
R=
0
1
Este procedimiento se realizo utilizando el paquete matemtico matlab y el cdigo
es el siguiente:
syms d1;
syms d2;
syms d3;
A1=[0 0 1 0; 1 0 0 0; 0 1 0 d1; 0 0 0 1];
A2=[0 0 -1 0; -1 0 0 0; 0 1 0 d2; 0 0 0 1];
A3=[1 0 0 0; 0 1 0 0; 0 0 1 d3; 0 0 0 1];
T=A1*A2*A3
B=[0;0;0;1];
R=T*B
Al realizar la compilacin del anterior cdigo arroja el siguiente resultado.
>> MATRICES
T=
[ 0, 1, 0, d2]
[ 0, 0, -1, -d3]
[-1, 0, 0, d1]
[ 0, 0, 0, 1]
82
R=
d2
-d3
d1
1
>>
Al ubicar estos valores con respecto al sistema de coordenadas de la base que se
observa en la Figura 6, se ven los desplazamientos del vector R en cada uno de
los eslabones para ubicar la herramienta en el punto final
83
Anexo B
Caractersticas tcnicas
de las correas dentadas
84
85
86
87
88
89
ANEXO C
CARACTERSTICAS
TCNICAS DEL
TORNILLO DE BOLAS RH
R-16-1
90
91
ANEXO D
CARACTERSTICAS
MOTOR PASO A PASO ST-42-48S-AA
92
93
94
ANEXO E
CARACTERSTICAS DEL
CILINDRO
95
96
Fuerza de impacto
97
Fuerza transversal
98
ANEXO F
CARACTERSTICAS DEL
CONTROLADOR SEC-ST48-6-P01
DIMENSIONES
99
100
101
102
ANEXO G
CARACTERSTICAS DE
LA PINZA PARALELA
HGP 06 A.
103
Dimensiones
104
Datos tcnicos
105
106
107
ANEXO H
SELECCIN DEL
CILINDRO UTILIZANDO
SOFTWARE FESTO
CATALOGO DE
NEUMTICA
108
109
4- Seleccin de cilindro
110
6- Seleccin de piezas
111
ANEXO I
SELECCIN DE LA
PINZA UTILIZANDO
SOFTWARE FESTO
CATALOGO DE
NEUMTICA
112
113
5- Sentido de apertura
114
6- Disposicin de la pinza
8- Presin de trabajo
115
9- Coeficiente de friccin
10-Factor de seguridad
116
ANEXO J
CALCULO NMERO DE
PULSOS PARA
UBICACIN EN LA
CELDA
117
118
ANEXO K
DISEO GRAFICO Y
PLANOS
119
Vista eslabn 1
120
Vista eslabn 2
121
122
123