Beruflich Dokumente
Kultur Dokumente
ARMADAS ESPE
DEPARTAMENTO DE LA ENERGA Y MECNICA
INGENIERA MECATRNICA
Robtica
Industrial
Diseo y construccin de un Robot
Antropomrfico de tres grados de
libertad
Ing. Alexander Ibarra
MENDOZA VCTOR
MORALES DIEGO
NAULA IVN
PUGLLA JIMMY
ZAPATA LUIS
1 ROBOTICA INDUSTRIAL
Contenido
ndice de ilustraciones.................................................................................... 2
INTRODUCCIN.............................................................................................. 3
CAPTULO 1: GENERALIDADES........................................................................4
TEMA........................................................................................................... 4
OBJETIVOS................................................................................................... 4
MARCO TEORICO......................................................................................... 4
1.
Robot antropomrfico...........................................................................4
1.1 Nmero y tipo de Articulaciones........................................................4
1.2 Volumen de Trabajo...........................................................................6
1.3. Lenguaje de Programacin................................................................6
1.4. Aplicaciones...................................................................................... 6
1.5. Ventajas............................................................................................ 7
1.6. Desventajas...................................................................................... 8
Teach Pendant................................................................................. 21
Materiales y equipos.......................................................................22
4.2
2 ROBOTICA INDUSTRIAL
BIBLIOGRAFA............................................................................................... 24
ANEXOS........................................................................................................ 25
ndice de ilustracione
3 ROBOTICA INDUSTRIAL
INTRODUCCIN
El presente proyecto es el diseo e implementacin de un robot
antropomrfico de tres grados de libertad aplicando los
conocimientos adquiridos durante el transcurso de la carrera de
Ingeniera Mecatrnica y en la asignatura de Robtica Industrial.
Se determinarn las caractersticas constructivas, inventario de
componentes, apoyados en la construccin del diseo en 3D en un
software CAD, para la parte de operacin del robot se desarroll una
interfaz en el software ROS la misma permite controlar los actuadores
(motores paso a paso) para esta funcin tambin se desarroll un
dispositivo de control manual. El armazn del robot se lo har en
acrlico y los actuadores sern motores paso a paso bipolares.
Se justifica este proyecto al ver la necesidad del estudiante por
familiarizarse con el funcionamiento de los robots y verificar de forma
prctica lo observado tericamente en clases, y as demostrar que lo
estudiado tiene no solo un propsito didctico, sino tambin una
aplicacin real en el campo laboral ya que cada vez es mayor el
nmero de robots industriales que se usan en las empresas alrededor
del mundo, en especial en lneas de produccin automatizadas, donde
los robots juegan un papel importante en la ejecucin de tareas
complejas y de alta repetibilidad.
4 ROBOTICA INDUSTRIAL
CAPTULO 1: GENERALIDADES
TEMA
Diseo e implementacin de un robot antropomrfico de tres grados de
libertad.
OBJETIVOS
General:
-
Especficos:
-
MARCO TEORICO
1. Robot antropomrfico
Robots Antropomrficos tambin llamados manipuladores de codo,
robots angulares, etc. Una configuracin de este tipo posee 3
articulaciones de posicionamiento y por general 3 articulaciones de
orientacin, es decir para el efector final, tambin llamado pinza o
gripper. [3] En las Figura 1 podemos ver un ejemplo de robot
antropomrfico:
5 ROBOTICA INDUSTRIAL
1.1 Nmero y tipo de Articulaciones.
Como se dijo anteriormente este robot tiene o est formado por 3 ejes
rotacionales llamados tambin 3G o RRR, el primer eje bsicamente
es perpendicular al piso, los otros dos perpendiculares al primero y
paralelos entre s, estos 3 se utilizan para posicionar al robot en un
determinado lugar del espacio. [4]
6 ROBOTICA INDUSTRIAL
7 ROBOTICA INDUSTRIAL
Tabla 2. Lenguajes de programacin y sistemas operativos. [2]
1.4. Aplicaciones
Existen numerosas aplicaciones dentro de la industria para esta
configuracin:
Ensamblado
Soldadura
Carga y descarga
Corte y pulido
Paletizado y empacado
Pintura
8 ROBOTICA INDUSTRIAL
1.5. Ventajas
Hay muchas ventajas que se pueden enumerar para estos robots
como son:
Mejora el acceso con el efector final
Maniobrabilidad
Se asemeja al brazo humano (tareas repetitivas y pesadas)
Variacin de la posicin y orientacin (muchos grados de
libertad) [4]
1.6. Desventajas
As mismo tenemos algunas desventajas:
Desplazamiento de personal
Conllevan una alta inversin inicial.
Modelo matemtico complejo, ya que posee muchas
variables articulares (5 o 6).
9 ROBOTICA INDUSTRIAL
2. Motor paso a paso
10 ROBOTICA INDUSTRIAL
Unipolar:
Estos motores suelen tener 6 o 5 cables de salida, dependiendo de su
conexin interna. Este tipo se caracteriza por ser ms simple de controlar.
En la ilustracin 16 podemos apreciar un ejemplo de conexionado para
controlar un motor paso a paso unipolar mediante el uso de un ULN2803, el
cual es un arreglo de 8 transistores tipo Darlington capaces de manejar
cargas de hasta 500mA. Las entradas de activacin (Activa A, B, C y D)
pueden ser directamente activadas por un microcontrolador.
11 ROBOTICA INDUSTRIAL
se puede ver la tabla con la secuencia necesaria para controlar motores
paso a paso del tipo Bipolares:
Tabla 3. Secuencia de manejo de motor Bipolar.
3. Microcontrolador
Un Microcontrolador es un circuito integrado que incluye en su interior las
tres unidades funcionales de una computadora: CPU, Memoria y Unidades
de E/S, es decir, se trata de un computador completo en un solo circuito
integrado.
Microcontrolador Arduino Mega
12 ROBOTICA INDUSTRIAL
-
Especificaciones Tcnicas:
-
Voltaje Operativo: 5V
Voltaje de Entrada: 7-12V
Pines digitales de Entrada/Salida: 54 (de los cuales 15 proveen salida
PWM)
Pines anlogos de entrada: 16
Corriente DC por cada Pin Entrada/Salida: 40 mA
Corriente DC entregada en el Pin 3.3V: 50 mA
Memoria Flash: 256 KB (8KB usados por el bootloader)
EEPROM: 4KB
Clock Speed: 16 MHz
4. Driver L298N
5. Cadena Cinemtica
Dado que un robot puede considerar como una cadena cinemtica formada
por objetos rgidos o eslabones unidos entre s mediante articulaciones, se
puede establecer un sistema de referencia fijo situado en la base del robot y
13 ROBOTICA INDUSTRIAL
describir la localizacin de cada uno de los eslabones con respecto a dicho
sistema de referencia.
Articulacin. Conexin de dos cuerpos rgidos caracterizados por el
movimiento de un slido sobre otro.
Enlace. Cuerpo rgido que une dos ejes articulares adyacentes del
manipulador.
El tipo de cadena cinemtica empleado es por medio de un enlace rgido y
dos en las articulaciones, basados en la cinemtica del robot antropomrfico
que se muestra en la figura.
14 ROBOTICA INDUSTRIAL
disear un robot de tres grados de libertad de tal manera que tenga 3
movimientos, uno en la base o tronco para rotarlo, un segundo y tercero de
tipo angular.
Se debe considerar que los motores a pasos a usarse tengan el toque
necesario para mover los eslabones, y posteriormente el actuador que
estar en la muleca
Qu tipo de material se usar para la estructura general?
Para que el robot antropomrfico no sea tan pesado y los motores no tengan
que realizar una gran cantidad de esfuerzo se construy el armazn en
acrlico de 4mm de espesor, suficiente para que la estructura sea rgida,
pero ala ves liviana.
Para qu sirve el driver ULN298 del motor PAP?
ste controlador permitir controlar el giro y velocidad de giro de los
motores a pasos mediante seales TTL que se pueden obtener del
Microcontrolador Arduino por medio de una secuencia de salida desde las
salidas digitales del Microcontrolador hacia las entradas del driver
Cmo se controla un motor a pasos?
Hay tres modos de excitacin comnmente utilizados para motores paso a
paso; estos son paso completo, medio paso y micro stepping. En pleno
funcionamiento paso, el motor se mueve a travs de su ngulo de paso
bsico, es decir, un motor de 1,8 paso toma 200 pasos por revolucin del
motor.
La velocidad de los pasos o secuencia de pasos va a estar dada por medio
de un retraso variando el retraso variaremos la velocidad de los pasos.
Cmo se realiza el movimiento del robot?
El movimiento de dos de los eslabones est dado por dos motores
directamente conectados en las articulaciones estos son tanto en el tronco
como el brazo del robot donde los motores estn conectados directamente
con el centro de las estructuras sin usar ningn elemento de transmisin,
haciendo de este una transmisin directa.
15 ROBOTICA INDUSTRIAL
Ilustracin 15. Transmisin por medio de enlace rgido al antebrazo del prototipo
de robot antropomrfico.
16 ROBOTICA INDUSTRIAL
17 ROBOTICA INDUSTRIAL
4
1
Descripcin:
1. Botones A1+ y A1- permiten el movimiento del motor a pasos #1 en
sentido horario y anti horario respectivamente.
2. Botones A2+ y A2- permiten el movimiento del motor a pasos #2 en
sentido horario y anti horario respectivamente.
3. Botones A3+ y A3- permiten el movimiento del motor a pasos #3 en
sentido horario y anti horario respectivamente.
4. Imagen del robot antropomrfico.
18 ROBOTICA INDUSTRIAL
Diseo de los eslabones y estructura
Los eslabones y la estructura del robot se lo realizo en acrlico de 4mm de
espesor lo suficiente para que sea rgida y liviana a la vez, teniendo en
cuenta que la base del robot es la que ms carga va a soportar, se puso
unas ruedas locas que cumplen con dos propsitos, el primero es soportar la
estructura superior y el segundo puesto que tiene rulimanes es que se
pueda mover sin mucho rozamiento.
Medidas generales del robot y su alcance
En las medidas generales del robot tenemos las siguientes:
En reposo 33.5cm de alto x 18.5 cm de ancho
La altura mxima que alcanza desde la base es de 43cm
19 ROBOTICA INDUSTRIAL
20 ROBOTICA INDUSTRIAL
3.1.3 Programacin del Arduino
Programa principal
#include "funciones.h"
//#include "motor_pap.h"
#include "ROS.h"
void setup() {
init_motores();
init_ROS();
//Serial.begin(9600);
}
void loop() {
leer_botones();
//Serial.println(op);
mover_motores(op);
run_ROS();
delay(1);
}
Programa de libreras
o Ros
#include <ros.h>
#include <std_msgs/UInt16.h>
#include "motor_pap.h"
//#include "configME.h"
ros::NodeHandle nh;
void servo_cb( const std_msgs::UInt16& cmd_msg){
//servo.write(cmd_msg.data); //set servo angle, should be from 0180
mover_motores(cmd_msg.data);
}
ros::Subscriber<std_msgs::UInt16> sub("mover", servo_cb);
void init_ROS(void){
nh.initNode();
nh.subscribe(sub);
}
void run_ROS(void){
nh.spinOnce();
}
21 ROBOTICA INDUSTRIAL
Motorpap
#include <Stepper.h>
#include "configME.h"
Stepper eje_A1(STEPS1,M11,M12,M13,M14);
Stepper eje_A2(STEPS2,M21,M22,M23,M24);
Stepper eje_A3(STEPS3,M31,M32,M33,M34);
void init_motores(void){
eje_A1.setSpeed(8);
eje_A2.setSpeed(8);
eje_A3.setSpeed(8);
}
void mover_A1(bool dir){
if(dir){
eje_A1.step(1);
}
else{
eje_A1.step(-1);
}
}
void mover_A2(bool dir){
if(dir){
eje_A2.step(1);
}
else{
eje_A2.step(-1);
}
}
void mover_A3(bool dir){
if(dir){
eje_A3.step(1);
}
else{
eje_A3.step(-1);
}
}
void mover_motores(int selec){
switch (selec) {
case 1:
mover_A1(true);
break;
case 2:
mover_A1(false);
break;
case 3:
mover_A2(true);
break;
22 ROBOTICA INDUSTRIAL
case 4:
mover_A2(false);
break;
case 5:
mover_A3(true);
break;
case 6:
mover_A3(false);
break;
}
}
3.1.4 Circuito de control y potencia
Circuito de control
En la parte de control realizaremos la lectura de una entrada digital, y en
base a su lectura, activaremos el movimiento de un motor a pasos en un
sentido u otro.
Para esto se realiza un circuito que permita tener las entradas analgicas en
un estado lgico bajo, el cual consiste en colocar una resistencia a masa lo
cual nos permitir tener una seal limpia y sin errores.
Circuito de potencia
Para el circuito de potencia se ha utilizado el mdulo L298n, el cual nos
permite controlar los motores a pasos de mejor manera y de forma ms
23 ROBOTICA INDUSTRIAL
sencilla, por lo que simplemente se necesita una conexin directa con el
Arduino y la fuente de alimentacin.
24 ROBOTICA INDUSTRIAL
25 ROBOTICA INDUSTRIAL
A3
A3-
26 ROBOTICA INDUSTRIAL
Materiales y equipos
Arduino Mega.
Pernos y tuercas.
Cable de timbre.
Resistencias.
Fuente de energa.
4.2
27 ROBOTICA INDUSTRIAL
28 ROBOTICA INDUSTRIAL
restricciones entre elementos del mecanismo, posibilitando realizar
de manera rpida el anlisis cinemtico y dinmico del robot.
RECOMENDACIONES
-
BIBLIOGRAFA
[1] Maestra en Automatizacin y Control Industrial Nelson Sotomayor, MSc.
HTTP://CIECFIE.EPN.EDU.EC/MATERIAL/4TONIVEL/- ROBOTICA/ROBOTICA.PDF
[2] INTEFAZ DE CONTROL PARA UN BRAZO ROBOT ARTICULADO BASADO EN
SOFTWARE DE DESARROLLO INTEGRAL, RODRIGO ESCANDON CUEVA
HTTP://DSPACE.UPS.EDU.EC/BITSTREAM/123456789-/4646/1/UPSCT002637.PDF
[3] ROBOTS MOVILES Y ANTROPOMORFICOS, LUIS JAVIER AGUILAR CRUZ
HTTP://WWW.SLIDESHARE.NET/LUISAGUILARCRUZ/- ROBOTS-MVILES-YANTROPOMRFICOS
29 ROBOTICA INDUSTRIAL
[4] BRAZO ARTICULADO (ROBOT RRR)
HTTP://WWW.BUENASTAREAS.COM/ENSAYOS/BRAZOARTICULADO ROBOTRRR/1902454.HTML
[5] ASIGNATURA DE SISTEMAS MECANICOS, MECANISMOS I
HTTPS://WWW5.UVA.ES/GUIA_DOCENTE/UPLOADS/2012/448/42437/1/DOCUMENTO1.PDF
[6] ROBOT KUKA KR 16-2 HTTP://WWW.KUKAROBOTICS.
COM/ES/PRODUCTS/INDUSTRIAL_ ROBOTS/LOW/KR16_2/START.HTM
[7] ROBOTS KUKA KR16 SE OCUPAN DE LA SOLDADURA DE COMPONENTES
DE AUTOMVIL
EN LA EMPRESA AL-KO HTTP://WWW.KUKAROBOTICS.
COM/ES/SOLUTIONS/SOLUTIONS_ SEARCH/L_2014_AL-K.HTM
[8] KUKA ROBOTER SE AGARRA A UNA BOTELLA
HTTP://WWW.KUKAROBOTICS.
COM/ES/SOLUTIONS/SOLUTIONS_SEARCH/LR351_
KUKA_ROBOTS_TAKE_TO_THE_BOTTLE.HTM
Catlogo Arduino Mega. Consultado 2016/22/05.
http://www.cscjprofes.com/wpcontent/uploads/2014/02/teoria_arduino2009.pdf
Disponible
en:
ANEXOS
30 ROBOTICA INDUSTRIAL
31 ROBOTICA INDUSTRIAL