Professional Documents
Culture Documents
Reporte 3 Proyecto Banda, Brazo, Contenedor
Reporte 3 Proyecto Banda, Brazo, Contenedor
50
IMPLEMENTA SISTEMAS
AUTOMATIZADOS
Integrantes de Equipo:
Bernardo Martínez Aarón
(aaronbernardo2019@cbtis50.edu.mx)
Jiménez Macías Hugo Eduardo
(eduardjimenez2019@cbtis50.edu.mx)
Bárcenas Valencia Citlalli Nazaret
(citlallivalencia2019@cbtis50.edu.mx)
García Rivera Rodrigo
(rodriggarcia2019@cbtis50.edu.mx)
INDICE
INTRODUCCION:
DESARROLLO:
Tabla de verdad del Circuito.
Diagrama Esquemático de las Compuertas Lógicas.
Simulación en LiveWire del circuito para la PCB.
Funcionamiento de la Banda Transportadora gracias a la PCB.
Explicación del Programa del Brazo Robótico controlado por 4 Servomotores.
Explicación del Programa del Contendor con un solo Servomotor.
OBJETIVO:
El objetivo al que querernos llegar es de que en una banda transportadora,
transporte objetos o recipientes de diferentes tamaños (chico, mediano y grande),
estos tamaños serán medidos por las fotorresistencias que están al final de la banda
las cuales están acompañadas de un láser emitiendo su luz a las fotorresistencias
esto provoca que al interferir la seña del láser se detendrá detectando; si el objeto
es uno de los tamaños ya mencionados la banda y de ahí llegaría el brazo y lo
transportaría al contenedor y lo dejara en su lugar asignado según su tamaño. Eso
es nuestro gran objetivo para este proyecto.
MATERIAL A UTILIZAR:
UN BRAZO ROBOTICO. (Incluye 4 servos)
UN CONTENEDOR (Esta conformado por 1 servo, y se puede hacer de cualquier material, nuestro caso fue
hacer una figura geométrica hecha de papel cascaron y dividirlo en 3 partes para cada tamaño de los objetos).
UNA BANDA TRANSPORTADORA (Está conformada por un Moto reductor, hecha de madera).
SOFWARE DE ARDUINO.
DESARROLLO:
Tabla de verdad del Circuito.
Observamos en nuestra simulación que el pequeño va a una compuerta AND la cual consta de 2
entradas y una salida, y la salida de una de las compuertas AND va una de les entradas de la
compuerta OR. El mediano va a la otra entrada de la compuerta AND exactamente en la misma
donde conectamos el pequeño, después de conectar mediano a la entrada se hace la misma
conexión que se hizo en la salida de la compuerta AND yendo a la entrada de la misma compuerta
OR. Para el grande se necesita un inversor NOT, el cual va a la entrada del auxiliar y la salida de la
compuerta NOT va a otra compuerta AND a una de sus entradas, se hace un puente de la primer
entrada AND que es pequeño a la primer entrada de la segunda compuerta AND la cual corresponde
a grande, ya conectado el inversor a la AND la salida de la misma va a la entrada faltante de la
compuerta OR. Y por último la salida de la compuerta OR puede ir dirigida a un LED, con el cual se
podrá comprobar la tabla de verdad del circuito que vimos en el anterior punto.
En el material pusimos 2 reguladores de corriente (7805 y 7809) estos transistores nos ayudaran a
reducir el voltaje ya que se alimentara con 12v directamente, recordando que nuestro circuito debe
tener solo 5v de corriente continua y al poder ver más voltaje nuestras compuestas se podrían
quemar, esto se deberá poner en la PCB para poder alimentar el circuito, recordando que deben
llevar un disipador de calor ya que se calientan demasiado y también se colocara un capacitor para
almacene la energía del circuito, nuestra PCB trae un interruptor para el encendido y apagado de
nuestra PCB al poner en ON el circuito funciona y al ponerlo en OFF el circuito se apaga.
Para la parte de nuestros láseres y de las fotocelda, se colocan los láseres al final de un extremo de
la banda con una maderita, se conectan en serie; positivo con positivo, y negativo con negativo y se
conectan a las señales del transistor, las fotoceldas de igual manera se colocan al final de un extremo
de la banda pero como sabemos estas no tienen polaridad así que debemos colocar una por una en
las maderitas tratando de que el láser emita su luz lo más centrado a la fotocelda, estas de igual
manera van conectadas a la señal que emite el transistor. Para detectar los objetos en la banda
transportadora que estén pasando en frente del brazo robótico, utilizamos Se trata de colocar un
láser apuntando directamente a una fotorresistencia; Son muy sencillos de utilizar. Sólo los conectas
a 5 voltios y tendrás tu láser. Este haz de luz dirigido lo hacemos incidir sobre una fotorresistencia
(LDR).
Explicación del Programa del Brazo Robótico
Para el funcionamiento del código para nuestro brazo robótico, se declara como primera parte los
4 Servomotores los cuales los nombramos como servo1, servo2, etc. Indicamos en nuestro código
que los 4 servos se posicionen en un Angulo de 0°. En la etapa de void setup, declaramos los
pines correspondientes de cada servo para poder conectar a nuestro microcontrolador (ARDUINO).
En seguida va otro ciclo for en el cual el servomotor 3 se posicionara en 20° y se pondrá menor a
120° +=1. Con un retardo de 30 microsegundos, este servo es el que está posicionado en un
extremo del principio del brazo, este mismo permite subir y bajar el brazo según los ángulos
estimulados,
Abrimos otro ciclo for el cual pertenecerá al servo 4 el cual se posicionara en una Angulo de 30°y
se posicionara en Angulo no menor a 100° +=1, constara con un delay de 20 microsegundos, este
servo es el que está ubicado en la garra el cual permite abrir y cerrar para dejar o poner un objeto.
En otro ciclo for se conformara del servomotor 2 el cual está ubicado al otro extremo del brazo, al
igual que el servo 2 solamente que este permite que se incline hacia delante y hacia atrás; este
servo se posicionara en un Angulo de 20° y se pondrá a una Angulo de 180° +=1; con un retardo
de 50 microsegundos.
El servo 3 como bien recordamos es el que permite que el brazo se haga hacia enfrente y hacia
adelante, este se posiciono en un Angulo no menor a 120° ahora se posicionara en un Angulo de
40°, teniendo en cuanta que no sea mayor a 90°, con un retardo de 20 microsegundos, esto explica
que nuestro brazo se hará un poco para atrás para poder posicionarse recto para que no se caiga
el objeto que trae la garra.
El servomotor 1 el cual no se ha movido y sigue en su estado inicial de 0, girara 20° pero no siendo
menor al rango de 150° con un tiempo de retardo de 30 microsegundos, esto explica que nuestro
brazo girara hacia la izquierda o derecha, ya sea donde tengamos el contendor para poder
deshacerse del objeto.
Y por último ya posicionado el brazo hacia el contendor, nuestra garra estará posicionada en una
Angulo de 0° no menor a 100° ,el cual significa que está cerrada agarrando un objeto, al pasar el
tiempo de espera de 20 la garra se abrirá y soltara el objeto en el contendor ya sea en el espacio
de CHICO, MEDIANO o GRANDE, y después se cerrara la garra estando en un Angulo de 100°
posicionándose en su entado normal de 0°, esto igual implica un tiempo de retardo de 20
microsegundos.
Como conclusión entendemos que cada ciclo for es una orden para cada servo, obviamente
respetando la posición de cada servo en el brazo, ya que alguno no pueden dar un giro de 180°, ya
que la consecuencia seria que rosarían y no alcanzarían a dar el giro completo.
Explicación del Programa del Contendor con un solo Servomotor.
Para el código de nuestro contendor, vemos que tenemos que utilizar otro ARDUINO ya que
ocuparemos una señal del microcontrolador, pero está ocupada por un servo del brazo robótico,
por eso se utilizó otro arduino,
La señal de nuestro servomotor va hacia la señal 9 del ARDUINO, y en nuestra placa de prototipo
PCB sacamos 4 señales, 3 de ellas pertenecen a CHICO, MEDIANO y GRANDE, y la que sobra
seria GND, estas entradas se conectan a las señales analógicas: para chico seria A0, para
mediano A1, para grande A2.
La banda, al pasar un objeto chico el servo del contendor se quedara en posición 0, hace su
trabajo el brazo de llevarlo al contenedor, lo deja y el brazo regresa a su lugar, pasa un objeto
mediano, lo detecta y nuestro contendor girara 180° hacia la izquierda, el contendor siempre
aguardara hasta que llegue el objeto detectado, el brazo recoge objeto de la banda lo lleva al
contendor y lo deja en el espacio de mediano. La banda al detectar un objeto grande, el brazo lo
agarrara y nuestro contenedor girara de 180° a 0°, y de igual forma posicionándose de igual forma
en 90° para el contendor grande.
VIDEO DEL FUNCIONAMIENTO DEL PROYECTO.
https://drive.google.com/file/d/1rNwG76B4cbKWsFgwZse
QEjYNebMsbDCG/view?usp=sharing