Brazo Robot
Brazo Robot
Se realizan los clculos del diseo mecnico y electrnico necesarios que garanticen el buen
funcionamiento de la mquina. Para ello, se obtiene el modelo cinemtico del brazo robtico
por medio de la obtencin de los parmetros de Denavit-Hartenberg y el mtodo geomtrico.
Por otro lado, se obtiene el modelo dinmico del robot resolviendo las ecuaciones de Euler-
Lagrange. El dimensionamiento de piezas, ensamblaje y planos mecnicos del robot se
realiza mediante el software Autodesk Inventor; as como tambin se consigue exportar el
archivo CAD al software Matlab con la finalidad de corroborar una posible aplicacin del
diseo propuesto. Adems, se realiza los circuitos esquemticos del sistema usando el
programa Eagle, para la seleccin de componentes electrnicos se hace uso de diferentes
manuales y datasheets otorgados por los fabricantes. Para la cotizacin de los componentes
utilizados, se obtuvo proformas y cotizaciones por correo electrnico, cabe resaltar que en el
caso de componentes importados se est considerando el costo de envi.
Respecto a los resultados obtenidos, estos fueron positivos debido a que se consigue tener un
diseo de brazo robtico que sea seguro para el usuario debido a que contiene sensores de
corriente para evitar una sobrecarga en los motores y una parada de emergencia para detener
el movimiento del robot cuando se requiera. Adems, se le permite al usuario colocar las
diferentes ecuaciones de movimiento para el control de robot y de esta manera poder tener
un control libre a voluntad del usuario. Algunos clculos fueron realizados por el software
Autodesk Inventor, el reporte mostrado por este programa mostr un diseo valido y
resultados positivos que ratificaron como correctos los parmetros ingresados para su
anlisis.
i
ii
Dedicatoria
iii
AGRADECIMIENTOS
iv
INDICE DE CONTENIDO
Pg.
RESUMEN .............................................................................................................................. i
DEDICATORIA ....................................................................................................................iii
AGRADECIMIENTOS ......................................................................................................... iv
INTRODUCCIN .................................................................................................................. 1
I. ANTECEDENTES ................................................................................................ 2
1.1 Presentacin de la Problemtica............................................................................. 2
1.2 Estado de la Tecnologa ......................................................................................... 4
1.2.1 Productos en el mercado ........................................................................................ 4
1.2.2 Investigacin de la Tesis ........................................................................................ 6
1.2.3 Publicaciones de Paper .......................................................................................... 7
v
3.1.4 Sistema de motores y transmisin ........................................................................... 15
3.1.5 Sistema de Procesamiento de Datos ........................................................................ 15
3.2 Sensores y Actuadores ........................................................................................... 17
3.2.1 Sensores ................................................................................................................. 17
3.2.2 Actuadores ............................................................................................................. 20
3.2.3 Otros ...................................................................................................................... 23
3.3 Planos Mecnicos del Sistema mecatrnico ........................................................... 31
3.3.1 Ensamble del Robot ................................................................................................ 31
3.3.2 Ensamble de la base ................................................................................................ 32
3.3.3 Ensamble del brazo ................................................................................................. 34
3.3.4 Ensamble del antebrazo ........................................................................................... 36
3.3.5 Ensamble del acoplamiento del Gripper .................................................................. 38
3.4 Diagramas esquemticos de los circuitos del sistema mecatrnico ........................ 39
3.4.1 Circuito esquemtico de conexiones de Arduino..................................................... 39
3.4.2 Circuito esquemtico de conexiones del Roboclaw ................................................. 40
3.4.3 Circuito esquemtico de distribucin de voltaje ...................................................... 41
3.4.4 Circuito esquemtico de la tarjeta de sensado ......................................................... 41
3.5 Diseo de Control .................................................................................................. 43
3.5.1 Diagrama de Flujo Principal.................................................................................... 43
3.5.2 Diagrama de Flujo Subrutina de interrupcin externa ............................................. 44
3.5.3 Diagrama de Flujo de "Ir posicin Home" .............................................................. 45
3.5.4 Diagrama de Flujo de "Lectura de Datos" ............................................................... 48
3.5.5 Diagrama de Flujo "Accionamiento de Motores" .................................................... 48
CONCLUSIONES ................................................................................................................ 52
BIBLIOGRAFIA .................................................................................................................. 53
vi
INDICE DE TABLAS
Pg.
vii
INDICE DE FIGURAS
Pg.
viii
Figura 3.11: Motor Pololu 12VDC........................................................................................ 20
ix
Figura 3.34: Vista frontal del ensamble brazo ....................................................................... 35
x
LISTA DE SMBOLOS
P : Potencia [W]
t : Tiempo [s]
V : Voltaje [V]
R : Resistencia elctrica []
T : Torque [Nm]
xi
1
INTRODUCCION
Cabe resaltar que su carcasa es desmontable fcilmente, de esta manera el usuario podr
apreciar los diversos mecanismos usados en su construccin. Por ltimo, es ms econmico
respecto a la mayora de brazos robticos utilizados en centros de educacin superior.
2
CAPTULO 1
ANTECEDENTES
En los ltimos aos a nivel mundial se ha incrementado el uso de brazos robticos para
diferentes fines. Segn la IRF (Internacional Federation of Robotic) en el ao 2013 las
ventas se incrementaron en un 12% en el mundo. Amrica tampoco es la excepcin a este
aumento acelerado de adquisicin de robots, en el mismo ao fueron adquiridos 30,300
brazos robticos, siendo 8% ms que el ao 2012 [1].
Existen empresas que ofrecen brazos robticos orientados al aprendizaje; sin embargo, en su
mayora se enfocan en la operacin del robot. Por ejemplo, las empresas ABB [2] y FANUC
[3] brindan programas educacionales pero utilizan brazos robticos industriales para tales
fines. Un caso distinto es el brazo robtico de la empresa KUKA youbot [4], que es un
robot de sistema abierto orientado a la investigacin, el cual permite modificar el diseo de
3
su control; sin embargo, tiene un costo elevado que asciende aproximadamente a 15 mil
dlares [5] mientras que los robots industriales de la misma empresa pueden costar desde
6,750 dlares [6].
Es por este motivo que los centros educativos adquieren en su mayora robots industriales
para los laboratorios y la investigacin. Todos los brazos robticos industriales siguen
normas y patrones internacionales [7] respecto a la seguridad y condiciones mnimas para su
construccin; sin embargo cada uno se diferencia en las tecnologas utilizadas en su
estructura mecnica, software, hardware, etc. con la finalidad de proporcionar recursos que
satisfagan a sus clientes. Como los fabricantes buscan proteger la propiedad intelectual de
sus creadores, todas estas diferencias son colocadas en un sistema cerrado que imposibilita a
los investigadores, profesores y alumnos conocer y/o poder modificar las ecuaciones y los
diferentes parmetros de control de movimiento del robot. De esta manera, se limita en gran
medida el aprendizaje e impide la aplicacin de los conocimientos obtenidos en las clases
tericas o el de desarrollar investigacin e innovacin tecnolgica en cuanto al control de
movimiento avanzados.
Ante este problema, en la presente tesis se plantea el desarrollo del diseo de un brazo
robtico de 5 grados de libertad con un sistema de control abierto modificable por el usuario
y con un control de seguridad para evitar daos del robot por causa de colisiones y
sobrecarga de corriente de los motores. Este brazo robtico est orientado a la educacin
superior e investigacin en la ingeniera robtica con el fin de brindar una herramienta para
el aprendizaje y puesta en prctica de la tecnolgica en este campo.
4
Adems de los brazos robticos mostrados, existen actualmente en el mercado una gran
cantidad de brazos robticos con fines educativos para colegios pero no para la universidad e
investigacin. Este es el caso de Stacker Robot Kit, Khepera III, AL5D, Mini Robot Arm,
uArm, Owi Robotic Arm, etc [12]. De esta manera se busca recopilar las diferentes
caractersticas de los brazos robticos educacionales ya existentes para darle una solucin a
la problemtica planteada en los captulos anteriores.
planificacin de trayectoria.
CAPTULO 2
De 3 a 5 grados de libertad. El diseo del robot debe estar orientado a los ejemplos
utilizados en las clases tericas que el estudiante recibe en los cursos de robtica.
Sin carga mnima. El fin del robot es para el aprendizaje y no para la industria.
Masa menor a 8 kg. Debe ser de fcil transporte dentro y fuera del cualquier
espacio educativo o de investigacin.
Debe tener una parada de emergencia que este prximo al operador del robot.
Altura mxima de 800 mm y radio de operacin mxima de 600 mm.
Carcasa fcilmente desmontable. Se debe poder tener acceso a los mecanismos
internos y componentes electrnicos. De esta manera, el usuario tendr un mejor
entendimiento de la mecatrnica utilizada para la creacin del robot.
Estructura mecnica segura. No debe tener puntas o filos cortantes que puedan
daar al usuario que manipule el brazo robtico.
Generacin de ruido que no perturbe al usuario.
Temperatura de operacin de 2C a 40C.
9
Dar posicin en el tiempo. El sistema debe ser capaz de entregar al software usado
la posicin en el tiempo de cada articulacin del brazo robtico para poder realizar el
control del mismo.
Alimentacin elctrica de 220VAC a 60 Hz.
No usar fuentes adicionales. No debe ser necesario usar otras fuentes de voltaje
para energizar los dems componentes electrnicos que no trabajen a 220VAC.
Comunicacin serial robot-pc. Sistema capaz de controlar el brazo robtico
mediante comunicacin serial con la computadora.
Elemento
acoplamiento para
Gripper
Elemento base
giratoria
Elemento brazo
Led
Componentes
Electrnicos
Elemento base fija
Computadora
Usuario
Brazo robtico
Parada de
emergencia
CAPTULO 3
SISTEMA MECATRNICO
En la figura 3.1 se muestra el diagrama del funcionamiento del sistema mecatrnico, esta
cuenta con 5 sistemas esenciales los cuales son: Sistema de Procesamiento de datos, sistema
de alimentacin, sistema de control, sistema de transmisin de movimiento y sistema de
sensores. A continuacin se detallar el funcionamiento de cada uno de estos sistemas.
PC SOFTWARE FUENTE DE
DE 12VDC
PROCESAMIENTO
12 VDC
COMUNICACIN
SERIAL
POTENCIA
CONTROLADOR CONTROLADOR ELCTRICA SISTEMA DE
DE ROBOT DE MOTOR MOTORES Y
ARDUINO ROBOCLAW TRANSMISIN
PWM
ENCODER POSICIN
PULSO
SEAL DIGITAL MECNICO
CORRIENTE
SEAL DIGITAL TARJETA DE
SENSADO DE
CORRIENTE
LIMIT
SWITCH
El Sistema de Alimentacin de Energa Elctrica est constituido por una fuente de 12V [20]
y una tarjeta que distribuye el voltaje para los controladores de motor y el Arduino. La fuente
de voltaje tiene una entrada de 220VAC y dos salidas de 12V, cabe resaltar que la fuente
puede brindar una corriente hasta 10A, en el caso haya un exceso de corriente, la fuente
cuenta con un sistema de proteccin que evitara daos. Adems tambin se cuenta con un
fusible de 10A en la salida de la fuente y una llave trmica para el encendido del robot.
El Sistema de Control est constituido por el Arduino UNO y el Roboclaw 5A. El Arduino
UNO es una tarjeta electrnica la cual incluye un microcontrolador Atmega328 [21]. El
Roboclaw 5A es un controlador de motor que puede leer datos desde el encoder y realizar el
control de un motor mediante datos recibidos por sus pines de control S1 y S2. A
continuacin se detalla las funciones de estos componentes.
Est conformado por el Arduino UNO. Su funcin principal es recibir los datos enviados por
el software utilizado, luego realizar un procesamiento para obtener los parmetros que
debern ser enviados al Roboclaw. Al ya existir una librera del Roboclaw para el Arduino,
la comunicacin entre ambos se realiza de manera sencilla. Como funcin secundaria, el
Arduino realiza el frenado de los motores al recibir una interrupcin proveniente de la tarjeta
de sensado de corriente.
El Sistema de sensores est constituido por los encoders, sensores de corriente y limit
switches. Estos sensores servirn como retroalimentacin al controlador y se obtendrn
beneficios como precisin, seguridad y posicin de inicio del sistema. A continuacin se
detallan las funciones de cada sensor:
3.1.3.1 Encoders:
Esta tarjeta est constituida por sensores de corriente, comparadores y circuitos integrados
que conforman 4 compuertas lgicas OR cada una. La funcin principal es enviar una
interrupcin externa al controlador principal en el caso haya un exceso de corriente en
alguno de los motores. Adems, de identificar el motor que est realizando el sobresfuerzo
por medio del encendido de leds. El funcionamiento se detalla en el diagrama de bloques de
la figura 3.2.
Existen 5 limit switches ubicados de forma estratgica en cada una de las articulaciones del
brazo robtico. Al iniciar el sistema, un motor asociado a una articulacin ser accionado
hasta pulsar el limit switch asociado a l, inmediatamente despus el motor ser accionado
con un giro contrario al que se hizo inicialmente a una velocidad muy pequea. Se esperar
hasta que se desactive el pulsador del limit switch para detener el motor. Cabe resaltar que se
realiza el mismo procedimiento para cada una de las articulaciones de manera secuencial,
una despus de la otra. De esta manera se indicar que una articulacin ya lleg a su posicin
HOME.
15
Para obtener lo mostrado en la figura 3.3 se hace uso del software Matlab y la librera
SimMechanics. Esta librera proporciona un entorno de simulacin para sistemas 3D
mecnicos. De esta manera, es posible modelar el sistema usando bloques que representan
los cuerpos, articulaciones y limitaciones. Luego SimMechanics formula y resuelve las
ecuaciones de movimiento para el sistema mecnico completo. Modelos de sistemas CAD,
incluyendo la masa, la inercia, las articulaciones, limitacin, y la geometra 3D, se pueden
16
Adems, es posible utilizar la librera Robotic Toolbox que es una caja de herramientas
realizada para la investigacin y docencia en la robtica. Este es un software libre y
proporciona funciones para la manipulacin y conversin entre tipos de datos como vectores,
transformaciones homogneas, angulos de Euler, etc. que son necesarios para representar la
posicin y orientacin en tres dimesiones.
Por otro lado, el software Labview tambin cuenta con una librera destinada para la robtica
el cual es Labview Robotics Module. De esta manera Labview proporciona herramientas
necesarias para el desarrollo de la robtica. Ver figura 3.4.
En estas bibliotecas es posible utilizar la opcin Robotic Arm la cual brinda diferentes
opciones para el modelamiento de brazos robticos como se muestra en la figura 3.5:
Finalmente, se puede apreciar que es posible el control de un brazo robtico desde software
como Matlab o Labview. Estos programas brindan una gran cantidad de herramientas que
17
Esta placa est constituida principalmente por el integrado ACS712ELCTR-5A [23]. Este
sensor de corriente es capaz de medir de forma lineal corrientes de hasta 5 Amperios en
ambos sentidos (+5A y -5A). Produce en su salida una tensin lineal proporcional a la
corriente que atraviesa sus pines de medicin. En el sistema mecatrnico se usar en las
entradas de alimentacin de los motores para saber si el motor llega a tener alguna
sobrecarga elctrica producto de alguna colisin del brazo robtico.
Los sensores de corriente son colocados en la pared interna de la base fija como se aprecia en
la figura 3.7.
El Limit Switch Temco CN0134 [24] es un dispositivo electromecnico que funciona como
un interruptor y es accionado de forma mecnica. En el brazo robtico ser utilizado para
colocar el sistema mecatrnico en una posicin HOME, es decir en una posicin de inicio.
Es por ello que est ubicado de manera estratgica en cada una de las articulaciones y es
sostenido por medio de pernos colocados en los dos agujeros que contiene.
3.2.1.3 Encoder:
Se utilizar los encoders ya acoplados a los motores seleccionados. Este es un sensor de tipo
Efecto Hall que se utiliza para detectar la rotacin de un disco mgnetico unido al eje del
motor. En el sistema mecatrnico se usarn 5 encoders (uno para cada motor). Esto servir
como retroalimentacin al controlador del motor y reducir el error de posicin del motor.
De esta manera se podr realizar un mejor control y se obtendr una mayor precisin en
nuestro sistema. Estos datos del encoder sern enviados al controlador del motor para
mejorar el control de posicin y velocidad.
3.2.2 Actuadores:
3.2.2.1 Motores:
Se usar los motores Pololu modelo 37d57L de 12V [25] con encoder incorporado. El motor
tiene una reduccin de engranajes integrada de 131:1 que permitir aumentar su torque de
salida. Se selecciona este motor al cumplir las especificaciones de torque y velocidad de los
clculos realizados mostrados en el Anexo 2. En el sistema mecatrnico se usarn 5 motores,
cuatro de ellos ubicados en la base giratoria del robot y uno de ellos en la base fija. El motor
ubicado en la base fija se encargar de dar movimiento a un engranaje que girar de manera
sncrona con la base giratoria del robot. De la misma manera se tendr un motor en la base
giratoria que mediante un mecanismo por engranajes har mover el hombro del robot. Por
otro lado, un motor se encargar de dar la articulacin del codo mediante un mecanismo por
engranajes y correas dentadas. Por ltimo, dos de los motores se encargarn principalmente
de controlar el diferencial para darle movimiento en dos ejes al gripper (de inclinacin y
rotacin).
Se utilizar una reduccin por engranajes rectos para conseguir suficiente fuerza en la
articulacin del hombro. La relacin de transmisin es igual a 4, los clculos
correspondientes se aprecian en el anexo 3. El engranaje conducido est unido al eslabn del
brazo de robot y se encontrar apoyado en una barra la cual girar libremente respecto a
engranaje.
En la figura 3.12 se puede apreciar los dos tipos de movimientos que pueden existir; cabe
resaltar que si el motor gira en un sentido, el eslabn girar en el sentido contrario.
Por ltimo, el punto x mostrado representa el eje del motor y es en donde se inicia el
movimiento. Las flechas en cada imagen de la figura representan el sentido de giro en cada
parte del mecanismo.
22
Se utiliza una reduccin por engranaje recto y se transmite mediante correas dentadas la
fuerza necesaria para realizar la articulacin del codo. El engranaje conducido est unido a la
polea, de esta manera ambos se movern de manera sncrona y generar un movimiento en la
faja que a su vez conduce a una polea que se encuentra apoyado en una barra en la
articulacin del codo. Esta polea se une al eslabn del antebrazo para conseguir el
movimiento de la articulacin del codo.
En la figura 3.13 se puede apreciar los dos tipos de movimientos que pueden existir; cabe
resaltar que si el eje del motor gira en un sentido, el eslabn girar en el sentido contrario.
Esto se debe principalmente por el uso de engranajes rectos en este mecanismo.
Por ltimo, el punto x mostrado representa el eje del motor y es en donde se inicia el
movimiento. Las flechas en cada imagen de la figura representan el sentido de giro en cada
parte del mecanismo.
23
Figura 3.14: Representacin de inclinacin de gripper Figura 3.15: Representacin de giro de gripper
Fuente: Elaboracin propia Fuente: Elaboracin propia
Desde la base se comienza la transmisin por fajas para poder controlar un mecanismo
diferencial ubicado en la zona del gripper. Mediante un diferencial se realizarn los
movimientos de inclinacin (ver figura 3.14) y rotacin (ver figura 3.15) de la mueca para
obtener de esta manera dos grados de libertad a nuestro sistema. Cabe resaltar que un
movimiento en sentido horario u antihorario de ambos motores generar el giro sobre su
propio eje de la mueca del robot, mientras que al girar ambos en sentidos contrarios
generar la inclinacin de la mueca del robot.
3.2.3 Otros:
El Roboclaw es una tarjeta de control de motor que puede realizar un control PID y recibir
datos provenientes de un encoder para su retroalimentacin y de esta manera reducir el error
generado al controlar la posicin o velocidad del motor. Para el sistema mecatrnico ser
necesario el uso de 3 tarjetas para los 5 motores a utilizar debido a que cada roboclaw puede
controlar hasta dos motores. El roboclaw [8] se encargar de enviar los datos de la lectura de
los encoder al arduino y recibir instrucciones de este por sus pines de transmisin S1 y S2
para el control de los motores. Ser energizado a 12V ya que los motores seleccionados
trabajan con ese voltaje de alimentacin. Por otro lado, para el control digital se energizar
con 5V provenientes del Arduino [9]. Finalmente, el roboclaw permite configurar en 4
modos diferentes: Analgico, RC, Serial y Packet Serial. Para el caso del sistema
24
mecatrnico se utiliza en el modo Packet Serial ya que en este modo permite enviar y recibir
datos y se utilizan para ellos los pines S1 y S2 mencionado. Para obtener mayor informacin
revisar el Anexo 12.
Los 3 Roboclaws son ubicados en la base fija del robot, son colocadas en sus paredes
internas. Para mayor detalle ver la figura 3.17.
Microcontrolador Atmega328
Voltaje de Operacin 5V
Voltaje de entrada 7V-12V
Cantidad de pines digiales (I/O) 14 pines
Cantidad de pines analgicos 6 pines
Corriente continua 40 mA
Velocidad de Clock 16 MHz
Largo 68.6 mm
Ancho 53.4 mm
Peso 25gramos
26
El Arduino est ubicado en la base fija del robot con los conectores para la comunicacin y
alimentacin hacia a fuera de la estructura.
Se usa una fuente de 12VDC de la Marca Fesete y Modelo S-350-12 para energizar a los
motores. La fuente escogida cumple con los requerimientos presentados en el anexo 7. Tiene
una entrada de 220VAC y una salida constante de 12V Esta fuente de voltaje tiene un
sistema de proteccin contra corrientes excesivas; la mxima corriente aceptada es de 30A,
por lo que al superar esta corriente el sistema de proteccin acta para evitar daos en la
fuente. Para mayor informacin revisar su datasheet el cual se encuentra en el Anexo 13.
3.2.3.4. Leds:
Se usarn 4 leds difusos rojos para indicar la articulacin que falla en nuestro sistema. Un led
ser ubicado en la base fija, este sensor estar relacionado con el motor de la base y se
encender cuando se haya superado su corriente mxima. De la misma manera se colocar
un sensor en la base giratoria cerca a la articulacin del hombro y otro en el brazo al lado de
28
la articulacin del codo. Cabe resaltar que se utilizar un solo led para la articulacin de la
mueca ya que este cuenta con dos motores para realizar los movimientos de rotacin y giro.
Marca SDDE
Dimensiones 80 x 75 x 85 mm
2 tipos de contacto Contacto NC y NO
Agujero para cables 3 M20 (2 enroscados y 1 sin enroscar)
En la figura 3.32 se puede apreciar el ensamble entre la base fija (14) y la base giratoria
(13). El movimiento se realiza de forma directa trasladando el movimiento del motor a
un eje de acero que est apoyado en un rodamiento que permitir su respectivo giro. El
rodamiento utilizado es de tipo rgido de hilera de bolas que consigue soportar tanto
cargas axiales como radiales. La base fija ser sujetada por medio de dos prensas de
mano a la mesa de trabajo.
34
En la figura 3.33 se aprecia la vista isomtrica del ensamble del brazo. Para mayor detalle
revisar el anexo 11 plano 29.
En la figura 3.34 se aprecia las poleas (12 y 10), engranajes (8 y 13), eslabones (4 y 15),
elemento actuador de Limit Switch (6), piezas que sostienen rodamiento (14) y pernos (5, 9 y
13) que componen este brazo. Estos elementos son de material ULTEM 9085 y estn
sostenidos en una barra de acero (7) la cual tiene a sus extremos rodamientos que a su vez
esta sujetada por una pieza colocada en el ensamble de la base.
En la figura 3.35 se consigue apreciar que se colocan carcasas tanto en la parte delantera (1)
como posterior (3) del brazo, estas carcasas son de fcil retiro ya que estn colocadas
mediante pequeas pestaas a los eslabones mostrados en la figura 20. Adems se coloca un
Limit Switch (2) que ser accionado por una pieza del ensamble del antebrazo.
En la figura 3.36 se aprecia la vista isomtrica del ensamble del antebrazo. Para mayor
detalle revisar el anexo 11 plano 17.
En la figura 3.37, se aprecia la vista de planta del ensamble del antebrazo. Se puede apreciar
tanto la carcasa posterior (2) y la delantera (4). Estas carcasas se pueden retirar fcilmente
debido a que tienen pequeas pestaas que consiguen unirse con el eslabn de antebrazo, el
cual une el codo con la mueca del brazo robtico. Cabe mencionar que la pieza ubicada en
el extremo de la barra (3) se encargar de accionar los limit switches asociados a cada
articulacin. Por ltimo, en esta figura se puede apreciar engranajes. Todas estas piezas son
hechas de material ULTEM realizadas por una impresora 3D.
En la figura 3.38 se aprecia la vista frontal del ensamblaje del antebrazo. En este ensamble
hay una barra de acero para sostener el acoplamiento del gripper (8) y una barra de acero
para la articulacin con el ensamble del brazo (16). Adems tambin hay dos limit switches
(20) para posicionar la inclinacin y giro de la mueca. Cabe mencionar que el ensamble
tambin contiene correas dentadas (7), poleas (18) y rodamientos (12 y 17).
En la figura 3.39 se aprecia la vista isomtrica del ensamblaje del Acoplamiento del Gripper.
Para mayor detalle revisar el anexo 11 plano 30.
En la figura 3.40 se puede apreciar las partes que componen este ensamblaje, el elemento 1
es una barra que sostendr el gripper que se quiera colocar en este acoplamiento. Por otra
parte, en elemento 2 estar apoyada en la barra de la mueca (Ver figura 3.38 elemento 8)
y va a servir para que la barra de acoplamiento del gripper est sostenida y no pueda
desprenderse. Su segunda funcin es activar el limit switch al momento de realizar el giro
sobre su propio eje. El elemento es un engranaje que ser accionado por los dos engranajes
biselados mostrados en el ensamblaje del antebrazo. Por ltimo, los elementos 4 y 5 son
tornillos que servirn para asegurar las diferentes piezas en este ensamblaje.
El diagrama de conexiones para cada Roboclaw se puede apreciar en la figura 3.42. Se puede
apreciar que se realizar una comunicacin serial UART con el Arduino por los pines S1 y
S2. Adems su alimentacin elctrica de potencia ser dada por una fuente de 12VDC para
poder dar a los motores dicho voltaje como mximo. Se observa la conexin de los encoders
que son alimentados gracias a las salidas de 5VDC provenientes del Roboclaw. Por ltimo,
el Roboclaw posibilita controlar dos motores, por lo que se realiza dichas conexiones como
se puede apreciar en la figura 3.42.
Cabe resaltar que se configura 3 pines de transimisin y recepcin en el Arduino. Cada pin
S1 de los roboclaws es conectado a cada uno de los pines configurados como Tx en el
Arduino y los pines S2 son conectados a los pines Rx configurado como tal. Por ltimo, la
alimentacin de 5V se obtiene de una de las salidas del Arduino.
41
El sensor de corriente, medir la corriente en el motor y se obtendr una salida de voltaje que
ser comparado con un voltaje de referencia que ser diferente para cada motor, el clculo de
este valor se puede apreciar en el Anexo 5. Se usar un comparador para saber si se supera la
corriente nominal mxima de trabajo en el motor, es necesario dos integrados LM339 debido
a que cada uno cuenta con 4 comparadores y es necesario 5 en total. Todas las salidas de
estos comparadores sern conectadas a una compuerta OR 74AC32 [29]. De esta manera, en
el caso algn pin de salida del comparador sea 1 lgico, se enviar esta seal al 74AC32
que al ser una compuerta OR tendr en su salida un 1 lgico de igual manera. Esta seal
ser enviada al Arduino para activar una subrutina de interrupcin externa. Adems se
utilizar los voltajes de 5 V de cada salida de los comparadores para encender diferentes leds
ubicados en la estructura del brazo robtico. Esto se realiza con la finalidad de saber que
motor est superando su corriente mxima de trabajo. La alimentacin de 5 V es
proporcionada por el Arduino.
42
En este subcaptulo se muestra cada uno de los diagramas de flujo del sistema de
control realizado por el Arduino incluida la subrutina de interrupcin que se activa
cuando se recibe una seal en alta por el pin 2. Inicialmente se muestra el diagrama de
flujo principal y de la subrutina externa; luego se mostrar a ms detalle las diferentes
funciones a utilizadas en el diagrama de flujo principal.
IR POSICIN
HOME
LECTURA DE DATOS
ACCIONAMIENTO DE
MOTORES
SI DETENER
MOTOR LLEG A
MOTORES
POSICIN FINAL?
NO
DETENER MOTORES
INICIO
ENVIAR DATOS
VELOCIDAD IGUAL A
CERO A ROBOCLAW 1
ENVIAR DATOS
VELOCIDAD IGUAL A
CERO A ROBOCLAW 2
ENVIAR DATOS
VELOCIDAD IGUAL A
CERO A ROBOCLAW 3
FIN
Esta subrutina de interrupcin se activar al recibir una seal proveniente por el pin
2 de interrupcin del Arduino. Esta seal ser 0 o 1 dependiendo si algn motor
super su corriente mxima de operacin, la cual suceder si existe alguna colisin
del brazo robtico con algn agente externo. Tambin puede ser activada en el caso
se presione el botn de parada de emergencia. La funcin de esta subrutina es
detener los motores; para ello, el Arduino enva una velocidad igual a cero a los
Roboclaws. Se utilizar este algoritmo como modo de seguridad del sistema
mecatrnico, de esta manera se consigue evitar alguna sobrecarga elctrica que dae
los componentes internos de los controladores del motor.
45
INICIO
NO Accionar motor 1 en
Limit Switch 1 sentido directo a
pulsado? velocidad normal
SI
NO Accionar motor 1 en
Limit Switch 1
sentido inverso a
soltado?
velocidad muy baja
SI
Detener
motor 1
NO Accionar motor 2 en
Limit Switch 2
sentido directo a
pulsado?
velocidad normal
SI
NO
Limit Switch 2 Accionar motor 2 en
soltado? sentido inverso a
velocidad muy baja
SI
A
46
DETENER
MOTOR 2
NO Accionar motor 3 en
Limit Switch 3 sentido directo a
pulsado? velocidad normal
SI
NO Accionar motor 3 en
Limit Switch 3 sentido inverso a
soltado? velocidad muy baja
DETENER
MOTOR 3
Accionar motor 4 en
NO sentido directo y
Limit Switch 4 motor 5 en sentido
pulsado? inverso a velocidad
normal
SI
Accionar motor 4 en
NO sentido inverso y
Limit Switch 4 motor 5 en sentido
soltado? directo a velocidad
muy baja
SI
B
47
DETENER MOTOR 4
Y MOTOR 5
NO
Limit Switch 5 Accionar motor 4 y
pulsado? motor 5 en sentido
directo a velocidad
normal
SI
NO Accionar motor 4 y
Limit Switch 5 motor 5 en sentido
soltado? inverso a velocidad
muy baja
SI
DETENER MOTOR 4
Y MOTOR 5
FIN
Figura 3.47: Diagrama de Flujo Ir posicin Home
Fuente: Elaboracin propia
INICIO
LEER ARREGLO
DE VELOCIDAD
GUARDAR DATO DE
ARREGLO EN VARIABLES
FIN
Figura 3.48: Diagrama de Flujo Lectura de Datos
Fuente: Elaboracin propia
INICIO
ENVIO DE DATOS AL
ROBOCLAW 1
A
49
ENVIO DE DATOS AL
ROBOCLAW 2
ENVIO DE DATOS AL
ROBOCLAW 3
ENVIAR DATOS DE
POSICIN A LA PC
FIN
Figura 3.49: Diagrama de Flujo Accionamiento de Motores
Fuente: Elaboracin propia
CAPTULO 4
PRESUPUESTO
Subtotal 2104.29
Tipo de Cambio
3.14
51
Se puede observar que los componentes electrnicos ms caros son los controladores de
motor Roboclaw y los 5 motores dc. Por otro lado, se considera en el presupuesto todos los
componentes necesarios para realizar las tarjetas propuestas. Para obtener mayor detalle de
cada componente revisar el Anexo 9.
CAPTULO 5
CONCLUSIONES
BIBLIOGRAFA
[2] ABB. (2011, Julio.). ABB Robotics launches new Educational Package. Disponible:
http://www.abb.com/cawp/seitp202/f30f8e1876d77d42c12578cd002034b4.aspx
[3] FANUC. FANUC Robotics CERT Programs Teach Robotics and Enhance
Employees Skill. Disponible: http://robot.fanucamerica.com/robotics-articles/robot-
education-program-fanuc-cert.aspx
[5] R. Bischoff. KUKA youBot a milestone for education and research in mobile
manipulation, IEEE ICRA Workshop A new generation of educational robots.
Shanghai International Convention Center, China. 2011. Disponible:
http://www.best-of-robotics.org/pages/BRICS-events/icra2011/Bischoff_-
_KUKA_youBot_-
_a_milestone_for_education_and_research_in_mobile_manipulation.pdf
[9] Phenoptix, Pocket Sized Robot Arm #meArm V0.4, 2014. Disponible:
http://www.adafruit.com/datasheets/Pocket-Sized-Robot-Arm-meArm-V04.pdf
[12] Intorobotic, Robotic Arm Kits For Your Next Proyect, 2014. Disponible:
http://www.intorobotics.com/robotic-arm-kits-for-your-next-project/
[16] Pavol Krasansky, Filip Tth, Vladimir Villaverde Huertas, Boris Rohal-Ilkiv,
Basic Laboratory Experiments with an Educational Robotic Arm, Slovak
University of Technology, Eslovaquia, 2013.
[26] EBAY. (2015, Junio). NEW Hylec 1-Way A-Lock Mushroom Head Stop Push
Button. Disponible: http://www.ebay.es/itm/NEW-Hylec-1-Way-A-Lock-
Mushroom-Head-Stop-Push-Button-
/131504776485?pt=LH_DefaultDomain_3&hash=item1e9e4ba525#shpCntId