Beruflich Dokumente
Kultur Dokumente
INGENIERO ELECTROMECNICO
Madrid
Julio 2015
AUTORIZACIN PARA LA DIGITALIZACIN, DEPSITO Y DIVULGACIN EN ACCESO
ABIERTO (RESTRINGIDO) DE DOCUMENTACIN
En caso de ser cotitular, el autor (firmante) declara asimismo que cuenta con el
consentimiento de los restantes titulares para hacer la presente cesin. En caso de previa
cesin a terceros de derechos de explotacin de la obra, el autor declara que tiene la oportuna
autorizacin de dichos titulares de derechos a los fines de esta cesin o bien que retiene la
facultad de ceder estos derechos en la forma prevista en la presente cesin y as lo acredita.
Con el fin de dar la mxima difusin a la obra citada a travs del Repositorio institucional de la
Universidad y hacer posible su utilizacin de forma libre y gratuita ( con las limitaciones que
ms adelante se detallan) por todos los usuarios del repositorio y del portal e-ciencia, el autor
CEDE a la Universidad Pontificia Comillas de forma gratuita y no exclusiva, por el mximo plazo
legal y con mbito universal, los derechos de digitalizacin, de archivo, de reproduccin, de
distribucin, de comunicacin pblica, incluido el derecho de puesta a disposicin electrnica,
tal y como se describen en la Ley de Propiedad Intelectual. El derecho de transformacin se
cede a los nicos efectos de lo dispuesto en la letra (a) del apartado siguiente.
3. Condiciones de la cesin.
1
Especificar si es una tesis doctoral, proyecto fin de carrera, proyecto fin de Mster o cualquier otro
trabajo que deba ser objeto de evaluacin acadmica
1
(a) Transformarla para adaptarla a cualquier tecnologa susceptible de incorporarla a internet;
realizar adaptaciones para hacer posible la utilizacin de la obra en formatos electrnicos, as
como incorporar metadatos para realizar el registro de la obra e incorporar marcas de agua
o cualquier otro sistema de seguridad o de proteccin.
(b) Reproducirla en un soporte digital para su incorporacin a una base de datos electrnica,
incluyendo el derecho de reproducir y almacenar la obra en servidores, a los efectos de
garantizar su seguridad, conservacin y preservar el formato. .
(c) Comunicarla y ponerla a disposicin del pblico a travs de un archivo abierto institucional,
accesible de modo libre y gratuito a travs de internet.2
El autor, en tanto que titular de una obra que cede con carcter no exclusivo a la Universidad
por medio de su registro en el Repositorio Institucional tiene derecho a:
b) Comunicar y dar publicidad a la obra en la versin que ceda y en otras posteriores a travs
de cualquier medio.
c) Solicitar la retirada de la obra del repositorio por causa justificada. A tal fin deber ponerse
en contacto con el vicerrector/a de investigacin (curiarte@rec.upcomillas.es).
d) Autorizar expresamente a COMILLAS para, en su caso, realizar los trmites necesarios para
la obtencin del ISBN.
2
En el supuesto de que el autor opte por el acceso restringido, este apartado quedara redactado en los
siguientes trminos:
(c) Comunicarla y ponerla a disposicin del pblico a travs de un archivo institucional, accesible de
modo restringido, en los trminos previstos en el Reglamento del Repositorio Institucional
3
En el supuesto de que el autor opte por el acceso restringido, este apartado quedara eliminado.
2
d) Recibir notificacin fehaciente de cualquier reclamacin que puedan formular terceras
personas en relacin con la obra y, en particular, de reclamaciones relativas a los derechos de
propiedad intelectual sobre ella.
El autor se compromete a:
a) Garantizar que el compromiso que adquiere mediante el presente escrito no infringe ningn
derecho de terceros, ya sean de propiedad industrial, intelectual o cualquier otro.
b) Garantizar que el contenido de las obras no atenta contra los derechos al honor, a la
intimidad y a la imagen de terceros.
c) Asumir toda reclamacin o responsabilidad, incluyendo las indemnizaciones por daos, que
pudieran ejercitarse contra la Universidad por terceros que vieran infringidos sus derechos e
intereses a causa de la cesin.
La obra se pondr a disposicin de los usuarios para que hagan de ella un uso justo y
respetuoso con los derechos del autor, segn lo permitido por la legislacin aplicable, y con
fines de estudio, investigacin, o cualquier otro fin lcito. Con dicha finalidad, la Universidad
asume los siguientes deberes y se reserva las siguientes facultades:
- La Universidad informar a los usuarios del archivo sobre los usos permitidos, y no garantiza
ni asume responsabilidad alguna por otras formas en que los usuarios hagan un uso posterior
de las obras no conforme con la legislacin vigente. El uso posterior, ms all de la copia
privada, requerir que se cite la fuente y se reconozca la autora, que no se obtenga beneficio
comercial, y que no se realicen obras derivadas.
- La Universidad no revisar el contenido de las obras, que en todo caso permanecer bajo la
responsabilidad exclusiva del autor y no estar obligada a ejercitar acciones legales en nombre
del autor en el supuesto de infracciones a derechos de propiedad intelectual derivados del
depsito y archivo de las obras. El autor renuncia a cualquier reclamacin frente a la
Universidad por las formas no ajustadas a la legislacin vigente en que los usuarios hagan uso
de las obras.
3
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Madrid
Julio 2015
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
GRADO EN INGENIERA ELECTROMECNICA
RESUMEN
RESUMEN
RESUMEN
RESUMEN
ABSTRACT
ABSTRACT
ABSTRACT
ABSTRACT
ndice de la memoria
1.3 Motivacin......................................................................................... 10
I
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
G
NDICE DE LA MEMORIA
3.2.2.1.2.5. ProcesoAcabado..................................................................... 43
3.2.2.1.2.6 DescartandoPale...................................................................... 43
II
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
NDICE DE FIGURAS
ndice de figuras
III
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
NDICE DE FIGURAS
IV
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
NDICE DE TABLAS
ndice de tablas
-1-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
NDICE DE TABLAS
-2-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
Parte I
MEMORIA
-3-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
-4-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
Captulo 1 INTRODUCCIN
-5-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
1.1.1 LA ROBTICA
-6-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
-7-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
-8-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
-9-
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
mientras que si tratsemos con personas habra que invertir en formacin sobre el
nuevo proceso que se quiera realizar, con el tiempo y coste que requiere llegar a
controlar un nuevo proceso industrial.
El objetivo principal del proyecto es conseguir que, de forma automtica, la
planta sea capaz de construir una figura de lego predeterminada. Para ello, se
tendrn que programar tanto la planta formada por la cinta transportadora y sus
actuadores como los distintos robots que participarn en el proceso.
Los citados robots que se van a utilizar en la planta para la construccin de
dicha figura son de la marca ABB, el modelo IRB 120 concretamente, y se trata de
brazos robotizados con seis grados de libertad, que son los movimientos que puede
hacer una articulacin independientemente de la anterior. Este dispositivo podra
utilizarse para bastantes tareas diferentes, en nuestro caso querremos que coja con
su pinza las piezas de lego de los pals y los suelte tras recorrer unas trayectorias
variables previamente programadas. Es un robot similar al brazo humano, que
estar acompaado por el resto de la planta, formada por una cinta transportadora
con dos subestaciones que tiene diversos actuadores.
Las piezas de LEGO con las que se va a trabajar son de dos por cuatro, y se
colocarn cuando vayan en los pals sobre un soporte con las dimensiones de los
enganches de las piezas, de tal forma que stas se queden fijas una vez son
apoyadas.
1.3 MOTIVACIN
- 10 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
- 11 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
1.4 OBJETIVOS
- 12 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
- 13 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
- 14 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
- 15 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
- 16 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
Los robots que se van a utilizar, situados en la segunda planta de ICAI, son
controlados por controladores IRC5 de ABB, encargados del movimiento del robot.
La programacin del robot se llevar a cabo a travs del dispositivo de mano
FlexPendant, puesto que una parte de la programacin consistir en la definicin de
puntos, para los que se necesitar utilizar el joystick que manipula los movimientos
del robot.
Para el manejo de la cinta transportadora y sus actuadores ser necesario
utilizar un autmata programable de la marca SIEMENS, que como se ha
comentado anteriormente se programar en el lenguaje AWL o lista de
instrucciones.
A la hora de sacar figuras de la cinta, se ha utilizado el programa AutoCad,
y para realizar los esquemas GRAFCET el programa Paint.
- 17 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Introduccin
- 18 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
DE MONTAJE
- 19 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 20 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
est manipulando el pal que se encuentra en alto. Todos los actuadores funcionan
con dos entradas neumticas, de tal forma que para activarlo debe recibir por una
de ellas un cero y por la otra un uno, de tal manera que la diferencia de presiones
entre los dos puntos desplace el actuador.
- 21 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 22 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
APARATOS Y PROGRAMACIN
La funcionalidad del PLC y del robot est dividida, puesto que cada uno
llevar a cabo una tarea diferente.
Los brazos robticos sern los encargados de mover las piezas de LEGO de
un sitio a otro utilizando como herramienta una pinza impresa en la propia
universidad con una impresora de tres dimensiones. Es una pinza que, igual que los
actuadores de la cinta, trabaja con dos entradas hidrulicas, definidas como salidas
del robot. De esta manera, cuando un pal llegue lleno de piezas, el robot las
utilizar para construir la estructura predeterminada, mientras que si el robot est
desmantelando la figura y le llega un pal vaco, el movimiento de la pieza ser el
contrario, es decir desde la estructura al pal.
- 23 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 24 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 25 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.2.1 CARACTERSTICAS
El robot IRB 120 es un brazo robtico articulado con seis grados de libertad,
como se muestra en la Figura 9, que puede manejar una carga til de 3 kg. Pesa 25
kg y tiene un alcance mximo de 580 milmetros, con un rango de alcance
prcticamente esfrico, excepto en una zona de aproximadamente 30 grados visto
desde arriba.
- 26 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 27 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Movimiento
- 28 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Cabe destacar en este robot el reducido tamao que tiene, pues en la posicin
de completamente estirado, la distancia entre la herramienta y el punto de apoyo es
de un metro y seis milmetros, con una huella cuadrada de 180 milmetros de lado,
lo que hace que se trate de un robot muy manejable que puede situarse en casi todos
los puntos que se encuentren a una distancia menor a la mxima.
- 29 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Entorno
Al final del robot se puede colocar una herramienta, es algo que se suele
hacer pues es sta la que le da una funcionalidad concreta al robot. As, si por
ejemplo a un brazo robtico se le instala en el extremo un spray de pintura, el brazo
ser un robot que puede pintar, o si se le instala un soldador ser un robot de soldar.
En este caso, como lo que se desea es que el robot manipule piezas de LEGO
cogindolas y soltndolas, se ha instalado una pinza de la marca SCHUNK en se
han incorporado dos garras especficas para coger las piezas, diseadas en
SolidEdge e impresas en la propia universidad (en una impresora de tres
dimensiones).
- 30 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 31 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Durante todo el proyecto hubo un problema con el agarre de las pinzas, hasta
tal punto que se pens en disear otras en lugar de stas, que ya estaban impresas.
Sin embargo, y tras muchas pruebas fallidas, se decidi colocar algo de cinta
adhesiva en los extremos de las cintas para aumentar la rugosidad de las mismas y
de tal forma su agarre, y aunque estticamente puede quedar algo rudo, aument
considerablemente la efectividad de las pinzas, de tal manera que no hubo que
disear otras diferentes.
- 32 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Adems, hay que tener en cuenta que las pinzas con las que se ha trabajado
plantean una limitacin, y es que no pueden manipular dos piezas que estn pegadas
si no tiene al menos cuatro agarres juntos libres, ya que al abrirse colisionara con
las piezas colindantes, limitacin que se ha tenido en cuenta a la hora de elegir la
estructura a realizar por el robot.
- 33 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 34 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.2.2.1 Cdigo
El cdigo que forma el programa de cada uno de los robots es muy parecido,
lo nico que cambia es el signo en el eje vertical, el eje z en cada uno de los
movimientos, puesto que mientras que uno de los robots est colgado de una
estructura, el otro est apoyado sobre otra, de tal manera que el mismo movimiento
que para uno implica un movimiento positivo, para otro equivale a uno negativo.
As, el programa est compuesto por dos partes diferenciadas: la primera es
la definicin de las variables que se van a utilizar durante todo el programa, y la
ltima est formada por los procedimientos que se van a ejecutar.
3.2.2.1.1 Variables
En el programa se utilizan tres tipos de variable: tipo herramienta (tooldata),
tipo posicin (robtarget) y tipo nmero (num).
Las variables tipo herramienta se han definido para poder llegar a posiciones
especiales con precisin, posiciones necesarias a la hora de sacar la pieza de la
estructura durante el desmantelamiento, ya que si nicamente se realiza un
movimiento vertical para coger la pieza, se pueden arrastrar con la pieza agarrada
las piezas que tenga debajo. Para evitar este problema se decidi realizar un
pequeo movimiento circular con centro la arista exterior de la pieza en la figura, y
- 35 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
es para la definicin de estos puntos para los que se ha utilizado la definicin de las
herramientas.
Los datos robtarget son de datos compuestos, es decir, guardan ms de un
valor. Aunque se declare como una variable normal, contiene un nmero
predefinido de valores. Concretamente, cada variable robtarget est compuesta por
un dato pos, un dato orient, un dato confdata y otro extjoint. El primero de ellos, el
pos, contiene tres valores numricos, que se corresponden con las coordenadas en
los ejes X, Y y Z. El segundo, el dato orient, especifica la orientacin de la
herramienta, posicin que se expresa mediante cuatro cuaterniones, que
proporcionan un anotacin matemtica para representar orientaciones y rotaciones
en tres dimensiones [15]. El tercer dato, el confdata, especifica los ngulos que ha
adoptado cada eje del robot para llegar a la posicin que se quiere guardar como
variable. Por ltimo, el dato exjoint especfica las posiciones de hasta seis ejes
adicionales, de tal manera que si no hay ningn eje adicional, se utiliza el valor 9E9
en cada uno de los seis campos. [16]
CONST robtarget
ppe03:=[[108.29,184.59,838.19],[0.482142,0.000181695,-4.71623E-
05,0.876093],[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
De esta manera, las variables de posicin se han utilizado para definir cada
uno de los puntos por los que se quiere que pasen los robots. Adems, todas las
variables robtarget se han definido de manera global, de tal forma que cualquier
procedimiento pueda acceder a ellas. Dentro de las variables robtarget podemos
diferenciar cuatro tipos de punto: los puntos previos del pal, que se llaman pppX,
y que son puntos 30 mm sobre la posicin que debe alcanzar la pinza para poder
agarrar la pieza; los puntos previos de la estructura, llamados ppeX, y que son igual
que los pppX pero sobre las piezas de la estructura del piso ms bajo de la
estructura. Adems de estos dos puntos, podemos encontrar los puntos prX, que
son puntos intermedios de la trayectoria entre pal y estructura por los que se hace
- 36 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
pasar al robot para que no colisione con ningn componente de la planta, como por
ejemplo las paredes del ascensor. Por ltimo, entre los puntos definidos en el
programa, podemos ver los puntos spX, que son los puntos que se obtienen al girar
la pieza para poder sacarla de la estructura, como previamente se ha explicado, y
estn definidos en el piso inferior de la estructura.
Por ltimo, en la programacin de los robots, se han utilizado variables de
tipo num, que puede contener datos numricos, ya sean enteros o decimales. La
primera de las variables de este tipo que se ha utilizado se llama cont, y es un
contador que sirve para que el robot haga un tipo de movimiento u otro, por
ejemplo, si numeramos del uno al cuatro las piezas que componen el piso inferior
de la estructura, digamos que si el contador es igual a cero, se corresponde con
tomar las piezas del pal y colocarlas en las posiciones uno y dos, mientras que si
el contador es igual a uno, el robot tomara tambin las piezas del pal, pero esta
vez para colocarlas en las posiciones tres y cuatro del piso inferior. De esta forma,
con la variable cont se controla que los movimientos del robot sean los adecuados
en cada momento para as poder construir o desmantelar la estructura en orden.
Tambin se han utilizado variables de tipo num para enviar informacin de
unos procedimientos a otros, concretamente cuando main llama a los
procedimientos CogePiezaDeEstructura y DejaPiezaEnEstructura, a los que se
deben pasar algunos offsets que deben aplicar para el correcto movimiento del
robot. En este caso las variables tipo num tendran decimales, mientras que en el
caso de cont, la variable solo toma valores enteros.
- 37 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.2.2.1.2 Procedimientos
En programacin, un procedimiento es una porcin de cdigo que forma
parte de un programa ms grande, que hace una tarea especfica y que funciona de
manera relativamente independiente al resto de cdigo. Suelen utilizarse para
reducir la duplicacin de cdigo y cuando son llamados por otros procedimientos o
mdulos pueden recibir parmetros, pero no necesitan devolver un valor, al
contrario que las funciones. [17]
En el programa que provoca el movimiento del robot, encontraremos cinco
procedimientos: main, CogePiezaDeEstructura, DejaPiezaEnEstructura,
CogePiezaDePale y ProcesoAcabado.
3.2.2.1.2.1. CogePiezaDeEstructura
En primer lugar, CogePiezaDeEstructura, como su propio nombre indica,
sirve para que el robot coja una pieza de la estructura formada. Es un procedimiento
que se ejecutar durante la fase de desmantelamiento de la figura formada por las
piezas.
- 38 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
del tipo robtarget, est PuntoGiroSacarPieza, que es una posicin a la que hay que
llevar la pieza para conseguir sacarla sin arrastrar en el movimiento las piezas
inferiores. Llevar el robot a esta posicin implica que la pieza gire teniendo como
eje su arista larga exterior a la estructura, de tal manera que disminuya el agarre con
las piezas inferiores, posibilitando que salga sin problemas. En tercer lugar se
pasar el offset necesario para alcanzar la pieza en el eje X, despus el necesario
para el eje Y, en quinto lugar el offset en el eje Z para coger la pieza, seguido del
offset en el eje Z 30 mm por encima de la pieza, en sexto lugar el offset necesario
en el eje Z con la orientacin una vez llevado a cabo el giro y elevado 30 mm y por
ltimo el offset necesario en el eje Z para que el punto se corresponda con el girado
de tal forma que la arista que hace de eje no se mueva, sino que rote el resto de la
pieza en torno a ella.
Entrando en las instrucciones, en primer lugar se puede apreciar un moveJ
hacia un punto prX, eso quiere decir que el robot se mover de la forma ms
eficiente, sin seguir una trayectoria predefinida, hacia el punto pr1, que es un punto
alejado de los objetos con riesgo de colisin. Le sigue otro moveJ hasta una posicin
30 mm sobre la pieza que se desea coger.
Despus vienen dos instrucciones SetDO, que sirven para dar un valor a una
salida digital. En este caso se est poniendo a 1 la salida DO10_7 y a 0 la DO10_8,
algo que sirve para abrir las pinzas, y es que aunque la pinza debera llegar abierta
porque la instruccin anterior debera haber sido de dejar una pieza, es una forma
de asegurarse de que llegue abierta.
Despus de que la pinza est abierta, baja hasta la posicin en la que puede
coger la pieza, cierra la pinza poniendo DO10_8 a 1 y DO10_7 a 0. Para accionar
la pinza hace falta actuar sobre dos seales diferentes porque, como ya se explic
anteriormente, se trata de unas pinzas neumticas, por lo que las dos seales que
estn relacionadas con la pinza deben tener valores opuestos.
Despus de cerrar las pinzas y agarrar la pieza, el robot realizar un
movimiento tal que la pieza gire sobre la arista inferior exterior de la estructura, de
tal manera que el agarre entre la pieza que se quiere extraer y las pinzas a las que
- 39 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
est conectada se debilite. La ltima orden hace que el robot suba 30 mm en el eje
Z desde la ltima posicin, de tal manera que la pieza es retirada por completo y
situada a una altura suficiente como para que el resto de piezas no estn en la
trayectoria del siguiente movimiento.
3.2.2.1.2.2. DejaPiezaEnEstructura
Este procedimiento tiene como finalidad dejar una pieza en la estructura
durante la fase de montaje, pieza que previamente se ha cogido de un pal.
- 40 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
depositar la pieza. Los dos SetDO siguientes abren las piezas para soltar la pieza y
por ltimo el robot vuelve a la posicin elevada 30 mm.
Todas las instrucciones de movimiento del programa se realizan con una
velocidad de 1 m/s, precisin tipo fine, excepto el primer MoveJ ya que no es
necesario que el robot pase exactamente por el punto tipo prX, y respecto a la
herramienta tool0.
3.2.2.1.2.3. CogePiezaDelPale
Este procedimiento tiene como objetivo que el robot coja una pieza del pal,
como su propio nombre indica.
Para conseguir que el robot se mueva de tal manera que se acerque al pal y
coja una pieza, en primer lugar se realiza un movimiento tipo MoveJ a un punto
prX, con velocidad de 1 m/s y sin necesidad de precisin tipo fine. Despus de este
movimiento, se abren las pinzas, que aunque deberan estar abiertas, tras ejecutar
los dos SetDO seguro que lo estn. El robot se sita sobre la pieza apoyada en el
pal y baja a la posicin del pal. Despus de este movimiento el robot cierra sus
pinzas y realiza un movimiento lineal vertical para sacar la pieza.
- 41 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.2.2.1.2.4. DejaPiezaEnPale
Este procedimiento se ejecutar tras haber cogido una pieza de la estructura,
en el proceso de desmontaje. De esta forma, el robot har un movimiento tal que
deje la pieza que tiene agarrada sobre el pal.
- 42 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.2.2.1.2.5. ProcesoAcabado
Este procedimiento tiene como objetivo enviar al PLC una seal que indica
que el robot ha terminado lo que tena que hacer con el pal y sus piezas.
PROC ProcesoAcabado()
SetDO DO10_6, 1;
WaitTime 1;
SetDO DO10_6, 0;
ENDPROC
Tabla 8. Programacin del procedimiento ProcesoAcabado
3.2.2.1.2.6 DescartandoPale
Este procedimiento tiene como fin dejar pasar un pal que al robot no le
interesa porque no tiene las condiciones necesarias para ser manipulado, es decir,
si el robot necesita un pal con piezas y el pal que llega no tiene, debe ser
descartado. Es muy similar a ProcesoAcabado.
PROC DescartandoPale()
SetDO DO10_4, 0;
WaitTime 6;
SetDO DO10_4, 1;
ENDPROC
- 43 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 44 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
como robot 3 y robot 4 a lo largo de la memoria, siendo el robot tres el que tiene
una cinta secundaria asociada y el robot cuatro el que tiene un ascensor de pals.
3.3.1 CARACTERSTICAS
- 45 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 46 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 47 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Igual que el anterior mdulo, este tambin tiene ms actuadores a parte del
brazo articulado, concretamente del tipo de detencin. Tambin tiene sensores
capacitivos para detectar la presencia o el paso de pals.
- 48 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 49 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 50 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 51 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Figura 28. Vista superior del mdulo de detencin XBPD 20x10 y sensor XBPB 12H
- 52 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.4 EL PLC
3.4.1 CARACTERSTICAS
- 53 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 54 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 55 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 56 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.4.2.1 Cdigo
Como se ha dicho anteriormente, el PLC se ha programado en lista de
instrucciones en este proyecto, por ser la ms esquemtica y en la que ms fcil es
la deteccin de errores en mi opinin. De esta manera, se va a proceder a explicar
brevemente cmo se ha programado cada transicin y estado con un ejemplo de
cada uno. Si se quiere estudiar con mayor detalle, se recomienda estudiar el
correspondiente Anexo.
3.4.2.1.1 Transiciones
Las transiciones son los pasos de una etapa a otra del GRAFCET.
- 57 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.4.2.2 Etapas
Cada etapa del GRAFCET, al ser activada, puede tener o no asociada una o
varias acciones. Habr en este proyecto etapas de espera en las que no se ejecutar
ninguna accin, simplemente se esperar que se den las condiciones para la
transicin, y etapas en las que se llevarn a cabo acciones.
El ejemplo que se va a mostrar es de este segundo tipo, es decir, su
activacin implica que se ejecuten ciertas acciones.
En esta etapa en particular, vemos que no slo se acta sobre las memorias
asociadas a las salidas relacionadas con un actuador, sino que adems se activa un
temporizador del tipo SD. Este tipo de temporizador comenzar a contar el tiempo
desde el momento en el que se entre en la etapa, e ir descontando de la cantidad
de tiempo para el que se le ha programado, en este caso 500 ms. De esta manera, y
como se puede ver en el esquema GRAFCET, para salir de esta etapa ser necesario
que el temporizador 1 se ponga a 1, algo que pasa cuando la etapa ha estado activa
durante 500 ms.
- 58 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 59 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
- 60 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
3.4.2.3 Variables
Como se ha comentado en el apartado de actuadores de la cinta, todos estos
son del tipo neumtico, de tal manera que por cada actuador hay asociadas dos
seales diferentes. Adems, hay prcticamente un sensor por cada actuador, como
se puede apreciar en la siguiente Figura.
- 61 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Conclusiones
Captulo 4 CONCLUSIONES
- 62 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Conclusiones
- 63 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Futuros desarrollos
- 64 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Futuros desarrollos
- 65 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Bibliografa
Captulo 6 BIBLIOGRAFA
- 66 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Bibliografa
- 67 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Bibliografa
- 68 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Bibliografa
Parte II
ESTUDIO ECONMICO
- 69 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Bibliografa
- 70 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Estudio econmico
- 71 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Estudio econmico
- 72 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Presupuesto
Captulo 2 PRESUPUESTO
Tcnico 30 4 120
Piezas de lego 30 1 30
- 73 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Presupuesto
- 74 -
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Anexo
ANEXO A:
PROGRAMACIN DEL
ROBOT 3
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Anexo
MODULEMainModule
VARboolflag1:=FALSE;
PERStooldatapinzapieza:=[TRUE,[[38.9563,33.7947,68.1499],[1,0,0,0]],[1,[0,0,35],
[0.292661,0,0,0.956216],0,0,0]];
TASKPERStooldatapinza:=[TRUE,[[45.1073,45.689,77.3448],[1,0,0,0]],[0.5,[0,0,0],
[1,0,0,0],0,0,0]];
CONSTrobtargetppe03:=[[108.29,184.59,838.19],
[0.482142,0.000181695,4.71623E05,0.876093],[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppe04:=[[107.63,120.22,838.38],
[0.482131,0.000209343,5.29364E05,0.876099],[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetsp01:=[[187.89,103.52,780.70],
[0.291566,0.0256589,0.00578763,0.956189],[0,0,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetsp02:=[[115.29,109.10,861.94],[0.279521,0.0509826,0.055806,0.95716],
[0,0,1,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetsp03:=[[103.41,198.41,868.91],
[0.479613,0.0661887,0.0534794,0.873344],[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetsp04:=[[102.87,109.55,870.88],[0.477723,0.0152757,0.0765605,0.875035],
[0,1,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetpr2:=[[201.24,105.90,696.89],
[0.486381,0.027733,0.000491706,0.873306],[0,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpr3:=[[19.57,199.32,668.19],
[0.482163,0.000818281,0.000765513,0.876081],[1,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
VARnumcont:=0;
CONSTrobtargetpr41:=[[19.57,199.31,668.19],
[0.48212,0.000799568,0.000792867,0.876104],[1,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetsp41:=[[118.39,100.94,859.92],[0.478909,0.102445,0.0576868,0.869956],
[0,1,1,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetsp31:=[[154.89,179.41,930.10],[0.47742,0.100864,0.119428,0.864658],
[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetppe01:=[[186.35,102.12,837.99],
[0.291711,0.025523,0.00574286,0.956149],[0,0,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpr4:=[[56.27,99.45,585.95],[0.478855,0.0207517,0.00682568,0.877622],
[2,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetppp1vie:=[[222.60,230.00,666.69],
[0.481823,0.00276631,0.00527704,0.876248],[2,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppp2vie:=[[252.79,151.06,665.86],
[0.4822,0.000458347,0.00043622,0.876061],[2,1,3,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppe02:=[[122.55,102.95,837.91],
[0.292507,0.0280479,0.00765969,0.955821],[0,0,1,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetaaa10:=[[199.06,107.72,867.02],
[0.308348,0.0358166,0.0128525,0.950512],[0,0,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetaaa20:=[[209.96,154.61,879.22],
[0.2898,0.0862648,0.00544871,0.953176],[0,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetpr1:=[[172.56,15.73,670.84],[0.362009,0.0676884,0.0337959,0.9291],
[1,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
Page 1 of 5
CONSTrobtargetsp33:=[[156.75,181.59,928.71],[0.477776,0.0675354,0.152104,0.862574],
[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetppp1:=[[222.30,214.14,665.92],
[0.481846,0.00287715,0.00523188,0.876236],[2,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetaa:=[[252.78,165.06,694.67],
[0.482181,0.000448358,0.000425346,0.876071],[2,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppp2:=[[252.77,165.05,664.67],
[0.482173,0.000477397,0.000482834,0.876076],[2,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
PROCmain()
cont:=0;
SetDODO10_5,0;
WaitTime10;
SetDODO10_5,1;
WHILETRUEDO
IFcont=0ANDDI10_6=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,0,0,0,30;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,0,0,0,30;
ProcesoAcabado;
cont:=1;
ENDIF
IFcont=1ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe03,0,0,0,30;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,0,0,30;
ProcesoAcabado;
cont:=2;
ENDIF
IFcont=2ANDDI10_6=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,63.85,0,20,10.5;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,63.85,0,20,10.5;
ProcesoAcabado;
cont:=3;
ENDIF
IFcont=3ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe03,0,63.85,20,10.5;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,63.85,20,10.5;
ProcesoAcabado;
cont:=4;
ENDIF
IFcont=4ANDDI10_6=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,0,0,40,8.3;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,0,0,40,8.3;
ProcesoAcabado;
Page 2 of 5
cont:=5;
ENDIF
IFcont=5ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe03,0,0,40,8.3;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,0,40,8.3;
ProcesoAcabado;
cont:=6;
ENDIF
IFcont=6ANDDI10_1=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,63.85,0,60,27.45;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,63.85,0,40,27.45;
ProcesoAcabado;
cont:=7;
ENDIF
IFcont=7ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe03,0,63.85,60,27.45;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,63.85,60,27.45;
ProcesoAcabado;
cont:=8;
ENDIF
IFcont=8ANDDI10_6=1THEN
CogePiezaDeEstructurappe02,sp01,63.85,0,27.45,60,90,57.45;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe01,sp02,63.85,0,27.45,60,90,57.45;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
cont:=9;
ENDIF
IFcont=9ANDDI10_6=1THEN
CogePiezaDeEstructurappe03,sp41,0,63.85,27.45,60,90,57.45;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe04,sp03,0,63.85,27.45,60,90,57.45;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
cont:=10;
ENDIF
IFcont=10ANDDI10_6=1THEN
CogePiezaDeEstructurappe01,sp01,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe02,sp02,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp2;
ProcesoAcabado;
cont:=11;
ENDIF
IFcont=11ANDDI10_6=1THEN
CogePiezaDeEstructurappe04,sp41,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe03,sp03,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp2;
Page 3 of 5
ProcesoAcabado;
cont:=12;
ENDIF
IFcont=12ANDDI10_6=1THEN
CogePiezaDeEstructurappe02,sp01,63.85,0,10.5,20,50,19.15;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe01,sp02,63.85,0,10.5,20,50,19.15;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
cont:=13;
ENDIF
IFcont=13ANDDI10_6=1THEN
CogePiezaDeEstructurappe03,sp04,0,63.85,10.5,20,50,19.15;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe04,sp03,0,63.85,10.5,20,50,19.15;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
cont:=14;
ENDIF
IFcont=14ANDDI10_6=1THEN
CogePiezaDeEstructurappe01,sp01,0,0,30,0,30,0;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe02,ppe02,0,0,30,0,0,30;
DejaPiezaEnPaleppp2;
ProcesoAcabado;
cont:=15;
ENDIF
IFcont=15ANDDI10_6=1THEN
CogePiezaDeEstructurappe04,sp41,0,0,30,0,30,0;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe03,sp03,0,0,30,0,30,0;
DejaPiezaEnPaleppp2;
ProcesoAcabado;
cont:=16;
SetDODO10_3,1;
ENDIF
IFcont=16ANDDI10_3=1THEN
DescartandoPale;
cont:=17;
ENDIF
IFcont=17ANDDI10_3=1THEN
DescartandoPale;
cont:=18;
ENDIF
IFcont=18ANDDI10_3=1THEN
DescartandoPale;
cont:=19;
ENDIF
IFcont=19ANDDI10_3=1THEN
DescartandoPale;
SetDODO10_3,0;
cont:=0;
ENDIF
ENDWHILE
ENDPROC
Page 4 of 5
PROCCogePiezaDelPale(robtargetPuntoPrevioPale)
MoveJpr4,v1000,z50,tool0;
SetDODO10_7,1;
SetDODO10_8,0;
MoveJPuntoPrevioPale,v1000,fine,tool0;
MoveLOffs(PuntoPrevioPale,0,0,30),v200,fine,tool0;
SetDODO10_7,0;
SetDODO10_8,1;
MoveLPuntoPrevioPale,v1000,fine,tool0;
ENDPROC
PROCDejaPiezaEnEstructura(robtargetPuntoPrevioEstructura,numoffx,numoffy,num
offzp,numoffz)
MoveJpr4,v1000,z50,tool0;
MoveJOffs(PuntoPrevioEstructura,offx,offy,offzp),v1000,fine,tool0;
MoveLOffs(PuntoPrevioEstructura,offx,offy,offz),v1000,fine,tool0;
SetDODO10_8,0;
SetDODO10_7,1;
MoveLOffs(PuntoPrevioEstructura,offx,offy,offzp),v1000,fine,tool0;
ENDPROC
PROCCogePiezaDeEstructura(robtargetPuntoPrevioEstr,robtargetPuntoGiroSacarPieza,num
offx,numoffy,numoffz,numoffzp,numoffzsp,numoffzs)
MoveJpr1,v1000,z50,tool0;
MoveJOffs(PuntoPrevioEstr,offx,offy,offzp),v1000,fine,tool0;
SetDODO10_7,1;
SetDODO10_8,0;
MoveLOffs(PuntoPrevioEstr,offx,offy,offz),v1000,fine,tool0;
SetDODO10_7,0;
SetDODO10_8,1;
MoveJOffs(PuntoGiroSacarPieza,0,0,offzs),v1000,fine,tool0;
MoveLOffs(PuntoGiroSacarPieza,0,0,offzsp),v1000,fine,tool0;
ENDPROC
PROCDejaPiezaEnPale(robtargetPuntoPrevioPale)
MoveJpr4,v1000,fine,tool0;
MoveJPuntoPrevioPale,v1000,fine,tool0;
MoveLOffs(PuntoPrevioPale,0,0,30),v1000,fine,tool0;
SetDODO10_8,0;
SetDODO10_7,1;
MoveLPuntoPrevioPale,v1000,fine,tool0;
ENDPROC
PROCProcesoAcabado()
SetDODO10_6,1;
WaitTime1;
SetDODO10_6,0;
ENDPROC
PROCDescartandoPale()
SetDODO10_4,0;
WaitTime6;
SetDODO10_4,1;
ENDPROC
ENDMODULE
Page 5 of 5
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Anexo
ANEXO B:
PROGRAMACIN DEL
ROBOT 4
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Anexo
MODULEMainModule
VARboolflag1:=FALSE;
PERStooldatapinzapieza:=[TRUE,[[38.9563,33.7947,68.1499],[1,0,0,0]],[1,[0,0,35],
[0.292661,0,0,0.956216],0,0,0]];
TASKPERStooldatapinza:=[TRUE,[[45.1073,45.689,77.3448],[1,0,0,0]],[0.5,[0,0,0],
[1,0,0,0],0,0,0]];
CONSTrobtargetpr2:=[[201.24,105.90,696.89],
[0.486381,0.027733,0.000491706,0.873306],[0,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpr3:=[[19.57,199.32,668.19],
[0.482163,0.000818281,0.000765513,0.876081],[1,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
VARnumcont:=0;
CONSTrobtargetpr41:=[[19.57,199.31,668.19],
[0.48212,0.000799568,0.000792867,0.876104],[1,1,2,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetsp41:=[[118.39,100.94,859.92],[0.478909,0.102445,0.0576868,0.869956],
[0,1,1,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetsp31:=[[154.89,179.41,930.10],[0.47742,0.100864,0.119428,0.864658],
[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetsp33:=[[156.75,181.59,928.71],[0.477776,0.0675354,0.152104,0.862574],
[0,0,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetpppa1:=[[126.67,453.57,520.92],
[0.0106899,0.407021,0.913318,0.00837334],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpppa2:=[[45.77,453.18,518.53],
[0.0106671,0.406989,0.913332,0.00837026],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppp2vie:=[[45.77,453.18,548.53],
[0.0106815,0.407016,0.913321,0.00832541],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppp1vie:=[[126.68,453.57,550.92],
[0.0106782,0.407008,0.913324,0.00834282],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppe01:=[[470.66,131.68,134.75],
[0.00849343,0.428283,0.903562,0.00881771],[0,0,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpr4:=[[260.81,189.01,662.72],[0.191313,0.521681,0.21893,0.802071],
[0,1,1,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetppe03:=[[390.82,150.15,136.01],
[0.0103411,0.345804,0.938249,0.00126776],[0,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetsp01:=[[500.69,137.80,108.91],[0.1556,0.435557,0.885662,0.0410103],
[0,0,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetsp02:=[[391.84,99.71,104.75],
[0.0808626,0.436727,0.895617,0.0245073],[0,1,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetsp03:=[[397.30,93.22,29.14],[0.0488305,0.339297,0.933038,0.109238],
[0,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetsp04:=[[477.67,270.86,24.13],[0.176558,0.917424,0.344639,0.0915677],
[0,1,2,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetpr1:=[[374.25,193.36,368.02],[0.311157,0.435908,0.837109,0.111418],
[0,1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetppe02:=[[408.65,229.40,136.29],
[0.00547182,0.900737,0.434193,0.010922],[0,0,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
Page 1 of 6
+09]];
CONSTrobtargetppe04:=[[489.20,212.58,135.59],
[0.00113939,0.94216,0.334874,0.0138882],[0,0,2,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetspp1:=[[526.54,139.51,26.20],[0.13554,0.42328,0.892938,0.0715927],
[0,0,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetspp2:=[[377.50,229.30,107.34],[0.0447526,0.890229,0.434473,0.129317],
[0,1,2,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetspp3:=[[398.80,87.72,26.03],[0.0356763,0.33062,0.934557,0.126573],
[0,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetspp4:=[[472.19,246.32,112.45],[0.107363,0.94051,0.305706,0.102269],
[0,1,0,1],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetppp11:=[[45.77,453.18,548.52],
[0.0106744,0.407045,0.913308,0.00831028],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpr5:=[[6.39,282.58,643.89],
[0.00837138,0.346194,0.938119,0.0035488],[0,0,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpr14:=[[6.39,282.58,643.89],
[0.00837138,0.346194,0.938119,0.0035488],[0,0,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppp1nue:=[[99.73,453.62,520.56],
[0.0097932,0.455042,0.890363,0.00975501],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppp1nue2:=[[61.13,451.99,519.82],
[0.00994118,0.407001,0.913314,0.0104794],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetpr6:=[[288.55,97.64,720.36],[0.459981,0.684475,0.428626,0.369041],
[0,0,2,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
CONSTrobtargetppp2:=[[61.13,452.00,549.81],
[0.00993852,0.40702,0.913305,0.0105177],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetaaa:=[[110.10,451.42,519.07],
[0.00981225,0.407105,0.913268,0.0104911],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
CONSTrobtargetppp1:=[[110.10,451.42,549.06],
[0.00982987,0.40712,0.913262,0.0104556],[1,0,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E
+09]];
PROCmain()
cont:=0;
WHILETRUEDO
IFcont=0ANDDI10_6=1THEN
CogePiezaDeEstructurappe03,spp4,0,63.85,27.45,60,90,57.45;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe04,spp3,0,63.85,27.8,60,90,57.45;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
cont:=1;
ENDIF
IFcont=1ANDDI10_6=1THEN
CogePiezaDeEstructurappe02,sp01,63.85,0,27.45,60,90,57.45;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe01,sp02,63.85,0,27.45,60,90,57.45;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
Page 2 of 6
cont:=2;
ENDIF
IFcont=2ANDDI10_6=1THEN
CogePiezaDeEstructurappe04,sp04,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe03,sp03,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp2;
ProcesoAcabado;
cont:=3;
ENDIF
IFcont=3ANDDI10_6=1THEN
CogePiezaDeEstructurappe01,sp01,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe02,sp02,0,0,8.3,40,70,38.3;
DejaPiezaEnPaleppp2;
ProcesoAcabado;
cont:=4;
ENDIF
IFcont=4ANDDI10_6=1THEN
CogePiezaDeEstructurappe03,sp04,0,63.85,10.5,20,50,19.15;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe04,sp03,0,63.85,10.5,20,50,19.15;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
cont:=5;
ENDIF
IFcont=5ANDDI10_6=1THEN
CogePiezaDeEstructurappe02,sp01,63.85,0,10.5,20,50,19.15;
DejaPiezaEnPaleppp2;
CogePiezaDeEstructurappe01,sp02,63.85,0,10.5,20,50,19.15;
DejaPiezaEnPaleppp1;
ProcesoAcabado;
cont:=6;
ENDIF
IFcont=6ANDDI10_6=1THEN
CogePiezaDeEstructurappe04,sp04,0,0,30,0,30,0;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe03,sp03,0,0,30,0,30,0;
DejaPiezaEnPaleppp2;
ProcesoAcabado;
cont:=7;
ENDIF
IFcont=7ANDDI10_6=1THEN
CogePiezaDeEstructurappe01,sp01,0,0,30,0,30,0;
DejaPiezaEnPaleppp1;
CogePiezaDeEstructurappe02,ppe02,0,0,30,0,0,30;
DejaPiezaEnPaleppp2;
ProcesoAcabado;
cont:=8;
SetDODO10_3,1;
ENDIF
IFcont=8ANDDI10_3=1THEN
DescartandoPale;
cont:=9;
ENDIF
Page 3 of 6
IFcont=9ANDDI10_3=1THEN
DescartandoPale;
cont:=10;
ENDIF
IFcont=10ANDDI10_3=1THEN
DescartandoPale;
cont:=11;
ENDIF
IFcont=11ANDDI10_3=1THEN
DescartandoPale;
SetDODO10_3,0;
cont:=12;
ENDIF
IFcont=12ANDDI10_6=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,0,0,0,30;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,0,0,0,30;
ProcesoAcabado;
cont:=13;
ENDIF
IFcont=13ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe03,0,0,0,30;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,0,0,30;
ProcesoAcabado;
cont:=14;
ENDIF
IFcont=15ANDDI10_6=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,63.85,0,20,10.5;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,63.85,0,20,10.5;
ProcesoAcabado;
cont:=15;
ENDIF
IFcont=15ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe03,0,63.85,20,10.5;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,63.85,20,10.5;
ProcesoAcabado;
cont:=16;
ENDIF
IFcont=16ANDDI10_6=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,0,0,40,8.3;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,0,0,40,8.3;
ProcesoAcabado;
cont:=17;
ENDIF
IFcont=17ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
Page 4 of 6
DejaPiezaEnEstructurappe03,0,0,40,8.3;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,0,40,8.3;
ProcesoAcabado;
cont:=18;
ENDIF
IFcont=18ANDDI10_6=1THEN
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe01,63.85,0,60,27.45;
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe02,63.85,0,40,27.45;
ProcesoAcabado;
cont:=19;
ENDIF
IFcont=19ANDDI10_6=1THEN
CogePiezaDelPaleppp2;
DejaPiezaEnEstructurappe03,0,63.85,60,27.45;
CogePiezaDelPaleppp1;
DejaPiezaEnEstructurappe04,0,63.85,60,27.45;
ProcesoAcabado;
cont:=0;
ENDIF
ENDWHILE
ENDPROC
PROCCogePiezaDelPale(robtargetPuntoPrevioPale)
MoveJpr4,v1000,z50,tool0;
SetDODO10_7,1;
SetDODO10_8,0;
MoveJPuntoPrevioPale,v1000,fine,tool0;
MoveLOffs(PuntoPrevioPale,0,0,30),v200,fine,tool0;
SetDODO10_7,0;
SetDODO10_8,1;
MoveLPuntoPrevioPale,v1000,fine,tool0;
ENDPROC
PROCDejaPiezaEnEstructura(robtargetPuntoPrevioEstructura,numoffx,numoffy,num
offzp,numoffz)
MoveJpr5,v1000,z50,tool0;
MoveJOffs(PuntoPrevioEstructura,offx,offy,offzp),v1000,fine,tool0;
MoveLOffs(PuntoPrevioEstructura,offx,offy,offz),v1000,fine,tool0;
SetDODO10_8,0;
SetDODO10_7,1;
MoveLOffs(PuntoPrevioEstructura,offx,offy,offzp),v1000,fine,tool0;
ENDPROC
PROCCogePiezaDeEstructura(robtargetPuntoPrevioEstr,robtargetPuntoGiroSacarPieza,num
offx,numoffy,numoffz,numoffzp,numoffzsp,numoffzs)
MoveJpr6,v1000,z50,tool0;
MoveJOffs(PuntoPrevioEstr,offx,offy,offzp),v1000,fine,tool0;
SetDODO10_7,1;
SetDODO10_8,0;
MoveLOffs(PuntoPrevioEstr,offx,offy,offz),v1000,fine,tool0;
SetDODO10_7,0;
SetDODO10_8,1;
MoveLOffs(PuntoPrevioEstr,offx,offy,offzp),v1000,fine,tool0;
MoveJOffs(PuntoGiroSacarPieza,0,0,offzs),v1000,fine,tool0;
ENDPROC
Page 5 of 6
PROCDejaPiezaEnPale(robtargetPuntoPrevioPale)
MoveJpr4,v1000,fine,tool0;
MoveJPuntoPrevioPale,v1000,fine,tool0;
MoveLOffs(PuntoPrevioPale,0,0,30),v1000,fine,tool0;
SetDODO10_8,0;
SetDODO10_7,1;
MoveLPuntoPrevioPale,v1000,fine,tool0;
ENDPROC
PROCProcesoAcabado()
SetDODO10_6,1;
WaitTime1;
SetDODO10_6,0;
ENDPROC
PROCDescartandoPale()
SetDODO10_4,0;
WaitTime6;
SetDODO10_4,1;
ENDPROC
ENDMODULE
Page 6 of 6
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Anexo
ANEXO C:
PROGRAMACIN DEL
PLC
UNIVERSIDAD PONTIFICIA COMILLAS
ESCUELA TCNICA SUPERIOR DE INGENIERA (ICAI)
INGENIERO ELECTROMECNICO
Anexo
Totally Integrated
Automation Portal
Main
Nombre Tipo de datos Offset Valor predet. Comentario
Temp
OB1_EV_CLASS Byte 0.0 Bits 0-3 = 1 (Coming event), Bits 4-7 = 1 (Event class 1)
OB1_SCAN_1 Byte 1.0 1 (Cold restart scan 1 of OB 1), 3 (Scan 2-n of OB 1)
OB1_PRIORITY Byte 2.0 Priority of OB Execution
OB1_OB_NUMBR Byte 3.0 1 (Organization block 1, OB1)
OB1_RESERVED_1 Byte 4.0 Reserved for system
OB1_RESERVED_2 Byte 5.0 Reserved for system
OB1_PREV_CYCLE Int 6.0 Cycle time of previous OB1 scan (milliseconds)
OB1_MIN_CYCLE Int 8.0 Minimum cycle time of OB1 (milliseconds)
OB1_MAX_CYCLE Int 10.0 Maximum cycle time of OB1 (milliseconds)
OB1_DATE_TIME Date_And_Time 12.0 Date and time OB1 started
Constant
0040 A "I_S4_LIFT_UP"
0041 = "ROBOT4_DI10_4"
0042 A "I_ROBOT4_E1"
0043 = "ROBOT4_DI10_5"
0044 // A "I_ROBOT4_E2"
0045 A "O_R4_1"
0046 = "ROBOT4_DI10_6"
0047 // A "I_ROBOT4_E3"
0048 A "O_R4_2"
0049 = "ROBOT4_DI10_7"
0050 A "I_ROBOT4_E4"
0051 = "ROBOT4_DI10_8"
0052
0053
Segmento 3: RESET34
0001 AN "RESET34"
0002 S "S0"
0003 R "S10"
0004 R "S2"
0005 R "S3"
0006 R "S4"
0007 R "S5"
0008 R "S6"
0009 R "S7"
0010 S "S20"
0011 R "S33"
0012 R "S12"
0013 R "S17"
0014 R "S13"
0015 R "S14"
0016 R "S18"
0017 R "S15"
0001 A "S0"
0002 = "SC0"
0003 A "S10"
0004 = "SC10"
0005 A "S2"
0006 = "SC2"
0007 A "S3"
0008 = "SC3"
0009 A "S4"
0010 = "SC4"
0011 A "S5"
0012 = "SC5"
0013 A "S6"
0014 = "SC6"
0015 A "S7"
0016 = "SC7"
0017 A "S1"
0018 = "SC1"
0019 A "S8"
0020 = "SC8"
0021 A "S20"
0022 = "SC20"
0023 A "S33"
0024 = "SC33"
0025 A "S12"
0026 = "SC12"
0027 A "S17"
0028 = "SC17"
0029 A "S19"
0030 = "SC19"
0031 A "S30"
0032 = "SC30"
0033 A "S13"
0034 = "SC13"
0035 A "S14"
0036 = "SC14"
0037 A "S18"
0038 = "SC18"
0039 A "S15"
0040 = "SC15"
0041 A "S11"
0042 = "SC11"
0043 A "S16"
0044 = "SC16"
Segmento 5: 0->10
0001 A "SC0"
0002 A "RESET34"
0003 S "S10"
0004 R "S0"
Segmento 6: 10->2
0001 A "SC10"
0002 A "I_C3_STOPH"
0003 AN "I_R3_2"
0004 S "S2"
0005 R "S10"
Segmento 7: 2->3
0001 A "SC2"
0002 A "T1"
0003 S "S3"
0004 R "S2"
Segmento 8: 3->4
0001 A "SC3"
0002 A "I_S3_PSTOP"
0003 S "S4"
0004 R "S3"
Segmento 9: 4->5
0001 A "SC4"
0002 A "I_S3_STOP"
0003 S "S5"
0004 R "S4"
0001 A "SC5"
0002 A "T2"
0003 S "S6"
0004 R "S5"
0001 A "SC6"
0002 A "I_R3_1"
0003 S "S7"
0004 R "S6"
0001 A "SC7"
0002 A "T4"
0003 S "S10"
0004 R "S7"
0001 A "SC10"
0002 A "I_R3_2"
0003 A "I_C3_STOPH"
0004 S "S1"
0005 R "S10"
0001 A "SC1"
0002 A "T5"
0003 S "S8"
0004 R "S1"
0001 A "SC8"
0002 A "I_R3_3"
0003 S "S10"
0004 R "S8"
0001 A "SC20"
Totally Integrated
Automation Portal
0002 A "RESET34"
0003 S "S33"
0004 R "S20"
0001 A "SC33"
0002 A "I_S4_PSTOP"
0003 AN "I_R4_2"
0004 S "S12"
0005 R "S33"
0001 A "SC12"
0002 A "T3"
0003 S "S17"
0004 R "S12"
0001 A "SC17"
0002 A "T8"
0003 S "S13"
0004 R "S17"
0001 A "SC13"
0002 A "I_S4_LIFT_UP"
0003 S "S14"
0004 R "S13"
0001 A "SC14"
0002 A "T6"
0003 S "S18"
0004 R "S14"
0001 A "SC18"
0002 A "I_R4_1"
0003 S "S15"
0004 R "S18"
Totally Integrated
Automation Portal
0001 A "SC15"
0002 A "I_S4_LIFT_DOWN"
0003 S "S19"
0004 R "S15"
0001 A "SC19"
0002 A "T7"
0003 S "S33"
0004 R "S19"
0001 A "SC33"
0002 A "I_R4_2"
0003 A "I_S4_PSTOP"
0004 S "S11"
0005 R "S33"
0001 A "SC11"
0002 A "T10"
0003 S "S16"
0004 R "S11"
0001 A "SC16"
0002 A "I_R4_3"
0003 S "S33"
0004 R "S16"
0001 A "SC2"
0002 S "MO_C3_STOPH_OFF"
0003 R "MO_C3_STOPH_ON"
0004 L S5T#500MS
0005 SD "T1"
0001 A "SC3"
0002 S "MO_C3_STOPH_ON"
0003 R "MO_C3_STOPH_OFF"
0004 R "MO_S3_PSTOP_ON"
0005 S "MO_S3_PSTOP_OFF"
0006 S "MO_C3_ARM_SP"
0007 R "MO_C3_ARM_ME"
0001 A "SC4"
0002 S "MO_S3_STOP_ON"
0003 R "MO_S3_STOP_OFF"
0004 R "MO_S3_LOC_UP"
0005 S "MO_S3_LOC_DOWN"
0006 R "MO_S3_PSTOP_ON"
0007 S "MO_S3_PSTOP_OFF"
0008 S "MO_C3_STOPS_OFF"
0009 R "MO_C3_STOPS_ON"
0010 S "MO_C3_ARM_ME"
0011 R "MO_C3_ARM_SP"
0001 A "SC5"
0002 S "MO_S3_STOP_ON"
0003 R "MO_S3_STOP_OFF"
0004 S "MO_S3_LOC_UP"
0005 R "MO_S3_LOC_DOWN"
0006 S "O_R3_1"
0007 L S5T#5S
0008 SD "T2"
0001 A "SC6"
0002 R "O_R3_1"
0001 A "SC7"
0002 S "MO_S3_LOC_DOWN"
0003 R "MO_S3_LOC_UP"
0004 S "MO_S3_STOP_OFF"
0005 R "MO_S3_STOP_ON"
Totally Integrated
Automation Portal
0006 S "MO_C3_STOPS_ON"
0007 R "MO_C3_STOPS_OFF"
0008 A "SC7"
0009 L S5T#6S
0010 SD "T4"
0001 A "SC1"
0002 S "MO_C3_STOPH_OFF"
0003 R "MO_C3_STOPH_ON"
0004 S "O_R3_2"
0005 L S5T#500MS
0006 SD "T5"
0001 A "SC8"
0002 S "MO_C3_STOPH_ON"
0003 R "MO_C3_STOPH_OFF"
0004 R "MO_C3_ARM_SP"
0005 S "MO_C3_ARM_ME"
0006 R "O_R3_2"
0007 A "SC8"
0008 L S5T#5S
0009 SD "T9"
0001 A "SC10"
0002 S "MO_C3_STOPH_ON"
0003 R "MO_C3_STOPH_OFF"
0004 S "MO_D34_RSTOP_OFF"
0005 R "MO_D34_RSTOP_ON"
0001 A "SC12"
0002 L S5T#500MS
0003 SD "T3"
0004 A "SC12"
0005 S "MO_S4_PSTOP_OFF"
0006 R "MO_S4_PSTOP_ON"
0007 R "MO_S4_STOP_ON"
0008 S "MO_S4_STOP_OFF"
0001 A "SC17"
0002 S "MO_S4_PSTOP_ON"
0003 R "MO_S4_PSTOP_OFF"
0004 S "MO_S4_STOP_ON"
0005 R "MO_S4_STOP_OFF"
0006 A "SC17"
0007 L S5T#4S
0008 SD "T8"
0001 A "SC13"
0002 S "MO_S4_LIFT_UP"
0003 R "MO_S4_LIFT_DOWN"
0004 S "MO_S4_STOP_ON"
0005 R "MO_S4_STOP_OFF"
0001 A "SC14"
0002 S "O_R4_1"
0003 A "SC14"
0004 L S5T#5S
0005 SD "T6"
0001 A "SC18"
0002 R "O_R4_1"
0001 A "SC15"
0002 R "MO_S4_LIFT_UP"
0003 S "MO_S4_LIFT_DOWN"
0004 S "MO_S4_STOP_OFF"
0005 R "MO_S4_STOP_ON"
0001 A "SC19"
0002 L S5T#7S
0003 SD "T7"
0001 A "SC11"
0002 L S5T#500MS
0003 SD "T10"
0004 A "SC11"
0005 S "MO_S4_PSTOP_OFF"
0006 R "MO_S4_PSTOP_ON"
0007 S "O_R4_2"
0001 A "SC16"
0002 S "MO_S4_STOP_OFF"
0003 R "MO_S4_STOP_ON"
0004 S "MO_S4_PSTOP_ON"
0005 R "MO_S4_PSTOP_OFF"
0006 R "O_R4_2"
0007 A "SC16"
0008 L S5T#6S
0009 SD "T11"
0001 A "SC0"
0002 // Seales gestionads por io_d34
0003 R "MO_D34_STOP_OFF"
0004 S "MO_D34_STOP_ON"
0005 S "MO_D34_RSTOP_OFF"
0006 R "MO_D34_RSTOP_ON"
0007 R "MO_D34_ARM_ST"
0008 S "MO_D34_ARM_SH"
0009 R "MO_C3_STOPH_OFF"
0010 S "MO_C3_STOPH_ON"
0011 S "MO_C3_STOPS_OFF"
0012 R "MO_C3_STOPS_ON"
0013 R "MO_C3_ARM_SP"
0014 S "MO_C3_ARM_ME"
0015 R "MO_CAM2_TRIGGER"
0016 // Seales gestionadas por io_s3
0017 R "MO_S3_PSTOP_OFF"
0018 S "MO_S3_PSTOP_ON"
0019 R "MO_S3_STOP_OFF"
0020 S "MO_S3_STOP_ON"
0021 S "MO_S3_LOC_DOWN"
0022 R "MO_S3_LOC_UP"
0023 // Seales gestionadas por io_s4
0024 R "MO_S4_PSTOP_OFF"
0025 S "MO_S4_PSTOP_ON"
0026 S "MO_S4_STOP_OFF"
0027 R "MO_S4_STOP_ON"
0028 S "MO_S4_LIFT_DOWN"
0029 R "MO_S4_LIFT_UP"