Академический Документы
Профессиональный Документы
Культура Документы
BSICO
MANIPULADOR ROBOT
MITSUBISHI RV-M1
CAP
Centro de Automatizacin de Procesos
Pontificia Universidad Javeriana Cali
MANUAL BSICO
MANIPULADOR ROBOT MITSUBISHI RV-M1
CAP
Centro de Automatizacin de Procesos
Pontificia Universidad Javeriana Cali
2001
Tabla de Contenido
Introduccin
1.
Caractersticas generales
2.
Encendido del sistema.
3.
Teaching box.
4.
Programacin del robot
4.1
Control de posicin y movimiento.
4.2
Control de programa.
4.3
Control de la mano.
4.4
Control de entrada y salida de datos
4.5
Control de comunicacin a travs de RS-232.
4.6
Utilizacin de algunos comandos en un programa
5.
Programas de comunicaciones para el robot Mitsubishi RV-M1.
5.1
Wardy.
5.1.1. Conexin con el robot (Connections)
5.1.2. Descargar posiciones guardadas en memoria
5.1.3. Enviar posiciones al robot
5.1.4. Descargar programa del controlador del robot
5.1.5. Enviar y ejecutar un programa
5.1.6. Envo de comandos individuales
5.1.7. Edicin de programas
5.2
MoveMaster Venturello
5.2.1. Conexin
5.2.2. Funciones de diferentes botones en la ventana principal
5.2.3. Manejo de archivos
5.2.4. Envo del programa al robot
5.2.5. Control de posiciones
5.2.6. Control de trayectorias
6.
Procedimientos ante la presencia de fallas.
Indice
Bibliografa
1
3
4
6
6
7
8
9
9
9
12
12
12
13
13
13
13
14
14
14
14
15
17
17
17
18
19
Introduccin
El Centro de Automatizacin de Procesos CAP, cuenta con 3 manipuladores robot Mitsubishi RVM1, que hacen parte de un sistema de manufactura flexible, en el cual se desempaan llevando a
cabo primordialmente, tareas de transporte de materiales.
Estos manipuladores, son utilizados adicionalmente como recurso fsico para desarrollar
proyectos de investigacin o verificacin de conceptos tericos asociados a algunas de las
asignaturas, que se cursan en las diferentes carreras de la Facultad de Ingeniera.
El siguiente manual, reune la informacin bsica requerida para utilizar el manipulador robot
Mitsubishi RV-M1 en condiciones seguras. Esta informacin resume y complementa la que
suministra el fabricante del robot en el manual: Industrial micro robot system model RV-M1
(signatura de biblioteca PUJ: 629.892M683i e1).
1. Caractersticas generales
El manipulador robot Mitsubishi RV-M1 cuenta con cinco grados de libertad (DOF). Su capacidad de
carga es de 1.2 Kg sin incluir el peso del efector final adaptado a l. El sistema que permite operar el
robot, se encuentra constituido por:
q
q
q
q
q
q
Brazo articulado.
Efector final (gripper, intercambiador de herramientas o sensor).
Teaching box.
Controlador.
Cables de conexin.
Computador con software para establecer comunicacin con el robot.
El brazo cuenta con cinco articulaciones que se pueden observar en la figura 1.1 y en el siguiente
listado:
q
q
q
q
q
J1: cintura.
J2: hombro.
J3: codo.
J4: pitch.
J5: roll.
Z
J3:Codo
E+ / EJ2: Hombro
S+ / SJ5: Roll
R+ / R-
J1:Citura
B+ / BJ4: Pitch
P+ / PX
Cada articulacin puede rotar de forma limitada, para ofrecer al robot la posibilidad de posicionarse
en cualquier lugar de un espacio confinado al que se le denomina volumen de trabajo del robot. La
figura 1.2 presenta los lmites de movimiento para cada articulacin y el volumen de trabajo para el
manipulador robot.
Lmites de las articulaciones (grados)
J1: -150 a 150
J2: -30 a 100
J3: 0 a 110
J4: -90 a 90
J5: -180 a 180
215
250
160
147
300
Dimensiones en mm
Encendido del
controlador
Parte posterior
Parte frontal
Indicador: encendido
Botn de EMERGENCIA
Indicador: error
Indicador: ejecucin de tarea
INICIO (programa)
DETENER (programa)
REINICIAR (controlador)
Figura 2.1 Partes frontal y posterior del controlador del robot
Fuente: Autor
En la figura 2.1 se observa que el controlador cuenta en la parte frontal, con una serie de botones e
indicadores cuyas funciones se incluyen a continuacin.
Indicador de encendido: se activa cuando se suministra potencia al controlador del robot.
Botn de emergencia: interrumpe la ejecucin de cualquier terea en desarrollo, dando lugar a una
alarma sonora intermitente que se suspende apagando el controlador.
Indicador de error: se activa cuando se produce un error. Generalmente se activa simultaneamente
una alarma sonora continua.
Botn de inicio: permite empezar la ejecucin del programa alamacenado en memoria.
Botn de parada: suspende la ejecucin del programa.
Botn para reiniciar el controlador (RESET): se utiliza para suspender el sonido continuo de una
alarma o la ejecucin de las lneas restantes de un programa que ha sido interrumpido mediante el
botn de parada.
3. Teaching box
Este dispositivo, permite manejar manualmente el robot. Cuenta con un teclado cuyos botones
presentan varias funciones segn el modo configurado.
En la tabla 3.1, se presentan los comandos mas utilizados cuando se opera manualmente el robot.
En ella se incluyen la secuencia de botones que se utiliza para habilitar cada una de las funciones del
teaching box. El siguiente ejemplo permite apreciar como se utiliza este dispositivo para crear una
posicin y mover el robot.
Ejemplo 3.1: Mediante el uso del teaching box lleve el robot a la posicin que se presenta en la figura
3.1 y guarde esta posicin en memoria asignndole el nmero 100. Posteriormente mueva el efector
final a lo largo del eje Y (direccin Y+). Finalmente retorne a la posicin 100 previamente definida.
Secuencia de
botones
INC
DEC
P.S <num> ENT
P.C < num> ENT
NST
ORG
MOV<num>ENT
PTP
XYZ
X+ o XY+ o YZ+ o ZB+ o BS+ o SE+ o EP+ o PR+ o RO
C
Funcin
Movim iento del robot a l a siguiente posicin def inida.
Movim iento del robot a l a anterior posicin definida en m emoria.
Guarda la posicin del robot asignndole un nmero.
Borra la posicin correspondiente al nmero indicado.
Lleva el robot a su origen mecnico (inicial izacin)
Iniciali za rotacin por arti culacin (J1=J2=J3=J4=J5= 0 grados).
Mueve a la posicin asociada a dicho nmero.
Activ a la opcin de mov imiento directo de las articul aciones.
Activ a la opcin de mov imiento en coordenadas cartesianas.
Mueve el ef ector final paralelo al eje X (coordenadas cartesianas).
Mueve el ef ector final paralelo al eje Y (coordenadas cartesianas).
Mueve el ef ector final paralelo al eje Z (coordenadas cartesianas).
Movim iento de la arti culacin J1 (ci ntura).
Movim iento de la arti culacin J2 (hom bro).
Movim iento de la arti culacin J3 (codo).
Movim iento de la arti culacin J4 (pitch).
Movim iento de la arti culacin J5 (rol l).
Abrir las pinzas.
Cerrar las pinzas.
ON /OFF
Botn de emergencia
Despliegue de datos
INC
DEC
X+
XB+
B-
P.S
P.C
Y+
YS+
S-
NST ORG
Z+
Z4 E+ 9 E-
TRN WRT
P+
3
P8
MOV STEP
R+
2
R7
PTP
+
1
XYZ
ENT Tool
<O> >C<
0
5
MS < posicin >, < nmero de puntos intermedios >, < O o C >
Genera movimiento desde la posicin actual hasta la nueva posicin pasando travs de un nmero
definido de puntos intermedios.
MT < posicin >,< distancia >,< O o C >
Movimiento en direccin de la herramienta a partir de la posicin dada, a lo largo de la distancia
definida.
NT
Lleva el robot a su origen mecnico.
OG
Lleva el robot al origen de movimiento por articulacin. J1=J2=J3=J4=J5= 0 grados.
PC < posicin 1 >, < posicin 2 >
Borra las posiciones definidas en el intervalo comprendido entre la posicin 1 y la posicin 2.
PD < posicin >,<coord. X>,<coord. Y>,<coord. Z>,<Pitch>,<Roll> (*)
Crea una posicin en las coordenadas dadas y con la orientacin definida por los ngulos pitch y roll.
PL < posicin 1 >,< posicin 2 >
Asigna las coordenadas y ngulos correspondientes a la posicin 2 a la posicin 1, borrando su
contenido en caso de que esta se encontrara definida previamente.
PX < posicin 1 >,< posicin 2 >
Asigna la posicin 1 a la posicin 2 y viceversa.
SF < posicin 1 >,< posicin 2 >
Asigna a la posicin 2 la suma de las coordenadas y ngulos de las posiciones 1 y 2.
SP < nivel 0 a 9 >, < H o L >
Define la velocidad de movimiento del robot y su aceleracin, que puede ser alta (H) o baja (L).
TI < contador de 0 a 32767 >
Espera un periodo de tiempo en segundos equivalente al valor del contador dividido entre 10.
TL < longitud >
Permite variar la longitud de la herramienta o efector final utilizados por el robot, para que los
clculos de posicin sean realizados en funcin de esta nueva dimensin.
GO
Abrir la mano.
GP < fuerza inicial >, < fuerza de retencin >, < tiempo de aplicacin de fuerza inicial >
Grada parcialmente la presin de la mano al momento de cerrar las pinzas.
10
20
25
27
150
160
170
180
190
200
210
220
230
310
315
320
330
730
740
750
770
780
790
800
810
820
830
880
DL 1,2048
OB +0
TI 2
SP 9,H
GP 10,15,15
GO
TI 5
MO 21,O
MO 22,O
SP 3,L
MO 23,O
MO 24,O
GC
TI 5
MS 23,4,C
SP 9,H
MO 22,C
MO 21,C
MO 61,C
MO 62,C
SP 3,L
MO 63,C
GO
TI 5
MO 62,O
SP 9,H
MO 61,O
MO 100,O
OB 0
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
'
10
Figura 4.1 Posiciones del robot para transporte de materiales entre ella banda y la fresadora.
Fuente: Ambiente de trabajo virtual desarrollado en Matlab para robot Mitsubishi RV-M1
11
Figura 5.2 Ajuste del programa segn configuracin del puerto serial utilizado
Fuente: Programa de comunicaciones Wardy 2
5.1.2. Descargar posiciones guardadas en memoria
Al presionar el botn superior derecho en la ventana principal del programa Wardy (ver figura 5.3), se
despliega una ventana en la que se introducen las posiciones inicial y final del grupo que se quiere
descargar. Suponiendo que en el controlador del robot se encuentren definidas las posiciones 50,
80, 90, 91 y 100; si se solicitan las posiciones comprendidas entre la posicin 60 y 95, se generar un
archivo (*.pos) que contiene lo siguiente:
PD 80, +200,+200,+100, -50,+10
PD 90, +250,+250,+ 50, -30,+10
PD 91, +150,+350,+ 100, -30,+10
El formato de declaracin de cada posicin est dado por el de la instruccin PD, incluida en el
listado de instrucciones (seccin 4.1)
5.1.3. Enviar posiciones al robot
Presionando el botn inferior derecho en la ventana principal del programa Wardy (ver figura 5.3),
aparece una ventana para seleccionar el archivo (*.pos) que contiene las nuevas posiciones. Una
vez enviado, segn el formato descrito en el prrafo anterior, las posiciones quedan definidas en
memoria y pueden ser utilizadas posteriormente, an despus de apagar y encender el controlador,
hasta que sean borradas o sustituidas por otras.
5.1.4. Descargar programa del controlador del robot
Cuando se enva un programa al robot, este puede ser recuperado mediante la utilizacin del botn
superior derecho de la ventan principal del programa Wardy (ver figura 5.3). Al presionar este botn
se genera un archivo (*.rob) cuyo nombre es suministrado por el usuario. El archivo contiene un
programa en el que cada rengln cuenta con un nmero de lnea y una instruccin.
5.1.5. Enviar y ejecutar un programa
Presionando el botn inferior derecho, se puede enviar un programa al robot. Para esto, en la
ventana que se despliega consecutivamente, se borran todos los programas mediante el botn
clear, se carga el programa seleccionado (*.rob) y finalmente se ejecuta (run).
13
Descargar posiciones
guardadas en memoria
Descargar programas
desde el controlador
del robot
Enviar y ejecutar
un programa
Enviar posiciones
al robot
Figura 5.3 Funciones de los botones de la ventana principal
Fuente: Programa de comunicaciones Wardy 2
5.1.6. Envo de comandos individuales
El men send data permite el envo de comandos individuales de utilidad, tales como:
RS (reset) que permite suspender el sonido de una seal de alarma continua.
NT (nest) que lleva el robot a su origen mecnico.
GO que abre las pinzas.
GC que cierra las pinzas.
MO para mover el robot a la posicin establecida por el usuario.
5.1.7. Edicin de programas
Aunque este program posee un editor propio, se recomienda no utilizarlo. Se puede emplear en su
lugar el Block de Notas, que no introduce caracteres adicionales al archivo (*.rob) generado. Cuando
un programa deba ser editado y enviado despus de haber sido ejecutado desde Wardy, ser
necesario renombrarlo.
Comentario
Comando
Nmero de lnea
Enviar reset
Enva seal de RESET, que interrumpe alarma sonora continua en caso de fallas por
programacin o ejecucin de comandos.
Borrar
Utiliza la instruccin NW para borrar programa y posiciones de la memoria del controlador.
Mover ngulos
Solicita al usuario los ngulos correspondientes a las articulaciones J1, J2, J3, J4 y J5, para mover el
robot.
Mover por coordenadas
Solicita las coordenadas a las que se desea mover el robot.
Ir a descanso
Movimiento a una posicin definida, en la que los frenos de las articulaciones J2 y J3 no se
encuentran sometidas a esfuerzo (ver figura 3.1).
16
17
18
19
Indice
Abrir mano, 15
alarmas sonoras, 19
Auto ejecutar, 17
B+ o B-, 5
Borrar, 16
Borrar programa existente, 17
botn de emergencia, 19
C, 5
Cerrar mano, 15
cintura, 1
codo, 1
Conexin, 14
Control de posiciones, 17
Control de trayectorias, 18
controlador, 3
CP < contador de 1 a 99 >, 7
CR < contador 1 a 99 >, 9
DA < nmero de bit >, 7
DC < contador >, 7
DEC, 5
Descargar posiciones, 13
Descargar programa, 13
Desconectarse, 15
DL < lnea 1 >,< lnea 2 >, 7
DP, 6
DR, 9
DW < distancia en x >, < distancia en y >, <
distancia en z >, 6
E+ o E-, 5
Edicin de programas, 14
Ejecutar programa, 15
Enviar comandos, 15
Enviar reset, 16
Enviar y ejecutar un programa, 13
Envo de comandos individuales, 14
Envo del programa al robot, 17
EQ < valor >, < nmero de lnea >, 7
ER, 9
GC, 8
GF < estado 0 o 1 >, 8
GO, 8
GP < fuerza inicial >, < fuerza de retencin >,
< tiempo de aplicacin de fuerza inicial >,
8
grados de libertad (DOF), 1
GS < nmero de lnea >, 7
GT < nmero de lnea >, 8
Paso a paso, 17
PC < posicin 1 >, < posicin 2 >, 7
PD < posicin >,<coord. X>,<coord.
Y>,<coord. Z>,<Pitch>,<Roll>, 7
pitch, 1
PL < posicin 1 >,< posicin 2 >, 7
posicin de descanso, 19
PR < nmero de posicin >, 9
PTP, 5
puerto serial, 11
PX < posicin 1 >,< posicin 2 >, 7
R+ o R-, 5
RC < nmero de repeticiones >, 8
RESET, 19
RN < lnea 1 >, < lnea 2 >, 8
roll, 1
RT, 8
S+ o S-, 5
BIBLIOGRAFIA
Industrial micro-robot system, model RV-M1, instruction manual. Mitsubishi Electric Corporation.
Nagoya. Japan.