Documente Academic
Documente Profesional
Documente Cultură
Introducción
Debido al gran interés que presenta el tema de la Robótica, es interesante poder realizar
algunos proyectos que nos puedan llevar a ese mágico mundo. El hecho de poder crear una
máquina, aunque pequeña, es un desafío importante dentro de la área de la Electrónica.
En el presente informe se expondrá el trabajo ha realizar, el cual es implementar un Robot
que pueda posicionarse sobre una línea negra y seguirla sin ningún problema. En nuestro caso se
le llamo cariñosamente OSO HORMIGUERO.
La función que debe cumplir este Robot, es poder seguir una línea negra la cual simula
una línea de hormigas, este seguimiento se produce gracias a la implementación de sensores que
infrarrojos. El Robot deberá seguir la línea trazada y en caso que de que ésta se le pierda, debe
ser capaz poder encontrarla sin problema.
Las diferentes etapas para desarrollar este proyecto, están basadas en lograr un buen
funcionamiento del Robot. Estas se pueden dividir en: Diseño de etapa de potencia, etapa de
implementación de sensores, puesta en marcha del microcontrolador y finalmente la etapa de
programación. La filosofía ocupada en este proyecto fue trabajar a conciencia y cumpliendo los
tiempos programados.
ZUMBADOR
CAPTADORES MODELO
LINEA OBSCURA ESTRUCTURAL
En este bloque, en realidad lo que se quiere expresar es que, se tuvo que realizar un
estudio del problema que se iba a tratar. Cuando uno ataca un problema debe tener en cuenta
todos los aspectos que se van a realizar, los pro y los contra del proyecto.
Cuando hablamos de robot debemos pensar en una maquina que sea capaz de moverse
independiente y autónoma. Se debe estudiar el microcontrolador a utilizar, la estructura que se
implementará, los sistemas de tracción a utilizar y la etapa de censado, además se tiene que
estudiar bien el sistema de control a utilizar.
CONTROL DE MOTORES:
Cuando nos referimos a este bloque, lo que queremos decir es que se tuvo que
implementar una etapa de censado para poder seguir la línea negra. Es importante mencionar lo
sensible que son los sensores en relación a la altura con el suelo, es por eso que se debe tener en
cuenta este aspecto para la implementación, esto se analizará más adelante con más detalle.
En esta etapa del diseño del robot, se consideraron varios aspectos que podían influir en la
lectura. Aquí también se contempla el diseño de la nariz del OSO HORMIGUERO.
ZUMBADOR:
En relación con este bloque, nos referimos aún circuito que se implemento prácticamente
al final del diseño, y fue para poder incluir un zumbador que diera la idea de censado, es decir, se
penso en un diseño de cuatro led más un zumbador que iban conectados a los motores y a los
sensores, también se explicará más adelante.
SENSORES DE CHOQUE:
Cuando nos referimos a este bloque, lo que se quiere decir es que se implemento un
circuito muy básico para los sensores de choque, pero por problemas de falsos pulso que
generaban los motores no resulto con éxito esta etapa.
Esta es una de las etapas más importantes del diseño del robot, ya que sin esta etapa el
OSO no podría funcionar correctamente. Se implemento un circuito que era el encargado de
controlar toda la información que ingresaba y toda la información que era necesaria sacar para
activar el robot y sus diferentes componentes.
En nuestro caso se utilizó el microcontrolador PIC 16C66 el cual a diferencia de otros era
muy poderoso en cuanto a memoria e instrucción que se podían utilizar. En este bloque se incluye
la implementación del PIC con sus componentes periféricos.
En este bloque lo que se realizó fue implementar físicamente todos los circuitos diseñados
con anterioridad, ubicarlos en el robot de tal manera de que se vean en forma ordenada.
Después de ubicados los circuitos en la estructura básica se realizó la etapa de
integrabilidad de cada circuito con la CPU.
Al mismo tiempo que se realizó la estructura final del robot, es decir, en esta etapa quedo
defina la forma que tendría el OSO incluyendo la forma de los sensores de choque, la
alimentación y la tapa, que cubrirían los circuitos.
PROGRAMACION:
PRUEBAS:
Cuando hablamos de prueba, nos referimos a que el robot debía funcionar ante cualquier
adversidad, es decir, se realizaron muchas pruebas tanto con el programa principal como con los
diferentes programas de estudio del PIC.
Todas las pruebas fueron realizadas en base a que el OSO HORMIGUERO pudiera seguir
la línea negra, controlando los motores y las velocidades de esto para que no se volviera loco.
Cumpliendo todas etapas se logro finalmente implementar un Robot llamado OSO HORMIGUERO
que al posicionarse sobre una línea obscura la pueda seguir sin problema.
En esta parte del informe se describirán los diferentes componentes de cada bloque que
fue mencionado anteriormente, esto se realiza con el fin de poder entender a cavalidad el
funcionamiento del robot.
CONTROL DE MOTORES:
Este bloque fue nombrado a grosso modo en el apartado anterior, es importante este
bloque debido a que sin esta etapa el robot no podría moverse.
Antes de hacer un esquema del circuito de los motores, se hará una pequeña reseña de
los componentes del circuito.
El driver de los motores, consiste en la utilización de dos puentes de transistores que
contemplan la parte de potencia, también llamada comúnmente configuración H. Se utilizaron 4
transistores PNP B632 y 4 transistores NPN BD-233, estos transistores fueron diseñados para
trabajar en corte y en saturación. Los puentes fueron alimentados con un voltaje de 3.6 volt., que
es proporcionado por una batería.
Debido al uso que se le dieron a los motores no fue necesario implementar un PWM, ya
que no importaba en cierta manera variar la velocidad de estos. Solo con el voltaje que se les
proporcionaba era suficiente para mover el robot.
Los transistores PNP se activan con cero volts y los transistores NPN se activan con 3.6
volts. Otro de los componentes de esta etapa son los diodos rectificadores, estos son de la familia
1N4007, que eran los encargados de proteger a los transistores de peak inversos de corriente.
Además se utilizó dos puertas lógicas, en las cuales se ingresaban diferentes entradas y
se obtenía las salidas , las cuales eran por ejemplo, los bit de sentido de los motores, con los
cuales se les da el sentido de giro de los motores.
Finalmente se utilizaron algunas resistencia para implementar el circuito de los motores.
Materiales utilizados:
2 TTL 7408
4 transistores NPN BD-233
4 transistores PNP B632
8 resistencias de 100 ohm
8 diodos 1N4007
Es importante mencionar que los motores se movían dependiendo de los bit de sentido y los
valores que estos tenían, es por eso que a continuación se dará una tabla con estos bit. Ejemplo
para un solo motor, ya que para el otro es lo mismo.(ver fig.1 en anexo)
Cuando se habla de captadores de línea obscura, se refiere a que son los encargados de
censar continuamente la línea para poder seguirla. El componente principal de funcionamiento del
circuito corresponde a un amplificador operacional LM339 trabajando como comparador.
Modo de funcionamiento
El LM339 posee en su interior cuatro circuitos comparadores de los cuales solo dos serán
ocupados (uno para cada sensor infrarrojo).
Primeramente se realizaron las pruebas sobre los sensores infrarrojos para saber cual
sería el voltaje umbral de trabajo de éstos, es decir, debe existir un cambio de voltaje en uno de
los terminales de cada sensor (0 o 1 lógico) ya sea cuando éste se encuentra dentro o fuera de la
línea. Una vez encontrado este voltaje de transición, se realiza el diseño del circuito.
El LM339 se polariza con 5 V en +Vcc y tierra, de acuerdo a esto el comparador nos
entregará una excursión de salida de +5V y tierra (0 V). Por lo tanto, la manera principal de hacer
trabajar los comparadores es realizando un diseño tal que en el terminal "v-" obtengamos el voltaje
umbral o de referencia sobre el cual se realizará la comparación. Así, a la salida de los
comparadores tendremos un cero lógico (0 V) si por el terminal "v+" ingresa un voltaje menor al de
referencia y un uno lógico (5 V) si por el ingresa un voltaje mayor.
La salida de uno de los comparadores corresponde al Sensor 1 mientras la otra salida
corresponde al Sensor 2. Luego estas señales son las que irían directamente al PIC 16C66 y de
acuerdo a los datos entregados por estas el microcontrolador actuará sobre el OSO según el
programa grabado en éste.
Es importante mencionar que cuando los sensores se encuentran dentro de la línea, en
este caso negra, entregarán un uno y en caso que se encuentren fuera entregarán un cero, estos
datos como se dijo irán directamente al PIC, el cual esta programado para actuar sobre el OSO.
Materiales utilizados:
LM 339
2 resistencias de 10K Ω
2 resistencias de 220 Ω
4 resistencias de 22k Ω
2 resistencias de 1.5k Ω
A continuación se muestra una figura, donde se visualiza como están colocados los
sensores dentro de la nariz del OSO HORMIGUERO. (Ver fig.2 del anexo)
ZUMBADOR:
Materiales utilizados:
Zumbador
1 resistencia de 180k Ω
1 resistencia de 3.9k Ω
1 resistencia de 560 Ω
2 transistores 2N2222
1 resistencia de 2k Ω
1 oscilador LM 555
Estos son los materiales utilizados para el zumbador, a continuación describimos los materiales
utilizados para los LED.
Materiales utilizados:
4 resistencias de 220 Ω
4 led
Descripción del circuito:
La descripción de este circuito ya se explico, en realidad cada led tenia una función en
especial, conectado a cada motor y cada sensor de lectura. El zumbador se alimento con un
voltaje de 5 volts y los led eran alimentados con un voltaje de 3.6 volts.(ver fig. 3 del anexo)
Program memory 8k
I/O pines 22
PWM 2
Timer modules 3
Es importante mencionar que este PIC posee tres puertos, en el caso del OSO
HORMIGUERO se utilizaron el puerto A como entrada, donde se colocaron los sensores de lectura
y los sensores de choque.
En el puerto B en cambio fue programado como salida donde se colocaron dos bit de
sentido de los motores y los otros dos bit de sentido del otro motor fueron colocados en el puerto C
que también fue programado como salida.
Se implemento un oscilador RC que trabajaba a 4Mhz. En los otros pines del
microcontrolador se coloco la alimentación de 5 volt y la tierra que estaba unida a todas las etapas
del robot.
Es importante mencionar que este PIC posee más de un banco de memoria, en este caso
se utilizo el primer banco, que por defecto es el 1, estos bancos se programan con el registro
STATUS.(ver mapa de memoria en anexo)
Cuando hablamos de modelo estructural del robot nos referimos a la forma final del OSO
HORMIGUERO, es decir, como quedo la estructura física con las diferentes etapas y la
implementación de los circuitos utilizados.
Es importante considerar los materiales utilizados, ya que son los que le dan la forma al
robot. Se utilizaron algunos materiales de bajo costo para poder implementar la estructura del
OSO HORMIGUERO. Entre los cuales se contempla el diseño de la nariz.
Nuestro proyecto de diseño que cariñosamente llamamos Oso hormiguero poseerá la siguiente
forma:
En esta etapa se recurrió a información de revistas para poder realizar los programas,
cabe destacar que estos fueron realizados en lenguaje asembly, debido a que el PIC se podía
programar en lenguaje asembly y lenguajes C, se utilizó el primero debido a que las instrucciones
eran de más fácil acceso.
A continuación se muestra un programa que activa los motores para su movimiento, esto
quiere decir que, se programo el PIC para que los motores se muevan en forma independiente.
Los otros programas realizados se pueden ver en los anexos. Para mayor claridad se explicará al
lado de cada instrucción la función que cumple.
movlw 0
tris Port_C
btfss Port_A,0
goto ATRAS1
goto ADELANTE1
btfss Port_A,1
goto ATRAS2
goto ADELANTE2
Como se puede ver el programa no es demasiado largo pero cumple con el objetivo, ya
que se trato de optimizar al máximo, sin caer en redundancia.
En los anexos se explicará con mayor claridad la forma de escribir un programa y la
manera de compilar.
SENSORES DE CHOQUE:
En este punto se implemento un circuito y un tipo de sensor de choque, cabe destacar que el
funcionamiento no fue del todo exitoso, pero la forma en que se implementaron fue la más
correcta, debido a un problema en los motores los sensores se activaban en forma falsa, que con
un estudio más profundo se podría mejorar.
Sensores de choque
Pruebas realizadas
En primer lugar las pruebas realizadas, fueron varias, se realizaron pruebas con los
motores para ver su buen funcionamiento, luego se realizaron pruebas con los sensores de lectura
(infrarrojo), así como también pruebas con el PIC que fueron las más importantes para poder
conocer el microcontrolador y finalmente las pruebas con los programas y los sensores de choque.
Aquí se realizaron varias pruebas con los motores, por ejemplo antes de implementar los
motores en el robot, se estudio el voltaje necesario para que la velocidad de estos fuera la
adecuada. Además de ver como funcionaban los bit de sentido de cada motor para regular el giro
de estos.
Después de realizar estas pruebas se llego a la conclusión que era necesario alimentar los
motores con 3.6 volt y una corriente superior a 1 amper, ya que con un banco de pilas no era
suficiente para mover los motores, ya que en los cambios de sentido los motores necesitaban una
corriente superior. Ver al mismo tiempo que los puentes, es decir la etapa de potencia estuviera
funcionando correctamente, después de realizado todo esto se pudo implementar los driver de los
motores en el robot.
Cuando se supo que el OSO trabajaría con sensores de lectura, infrarrojo, se requirió
implementar un circuito para el funcionamiento de estos, lo cual llevo a conocer la forma en que
estos trabajaban, se realizaron diferentes pruebas con el objetivo de saber cual era la distancia
optima de estos con el suelo, para no perder el punto de equilibrio necesario para censar
correctamente.
Las pruebas realizadas primero fueron hechas en una protoboard, implementando aquí el
circuito y viendo que resistencias eran las adecuadas, esto llevo como conclusión el voltaje
necesario para activar estos sensores. Al mismo tiempo se pudo concluir la distancia con el suelo,
la cual era aproximadamente de 4 a 5 mm del suelo.
Es importante mencionar que debido a que los sensores se encuentran demasiado juntos
uno del otro, lleva como consecuencia que la probabilidad de que los dos salieran de la línea era
muy alta, producto de esto se les separo una cierta distancia, esto también llevo a realizar varias
pruebas.
Aquí fue importante la realización de muchas pruebas, ya que sin el funcionamiento del
microcontrolador no funciona el robot.
Una de las primeras pruebas fue implementar un circuito para encender y apagar un led,
con esto se estudio la habilitación de los puertos como entradas y salidas. Esto llevo como
conclusión la forma de programar los puertos y además comenzar a conocer las instrucciones del
PIC.
Una segunda prueba fue activar dos led, de tal manera de activar por medio de un
interruptor uno a la vez, esto sirvió para poder conocer la forma de programar los puertos y como
utilizar los retardos de tal manera de mantener activado los led por un cierto instante.
Siguiendo con las pruebas, se realizaron varias pruebas con los motores y el PIC, esto
quiere decir que se implemento un programa que hiciera mover los motores simultáneamente,
controlados por el PIC. Esto llevo como conclusión que era necesario modificar el programa para
poder activar los motores, pero en forma independiente.
Al realizar varias pruebas con diferentes programas, se pudo llegar a mover los motores
en forma independiente, claro que los bit de cada motor salían por puertos distintos y por el puerto
A entraba la señal de control.
Luego con un programa diferente se realizaron pruebas para mover los motores, pero en
este caso se le agregaron los sensores infrarrojo, se tenia que tener en cuenta que los sensores
actuaban en forma simultáneamente con los motores, si el sensor derecho entrega un 1 el motor
izquierdo se debía mover hacia delante, y de esta forma tras varias horas de trabajo se pudo llegar
a mover en forma correcta los motores.
Finalmente la prueba final era mover los motores con los sensores y ya no apoyado de
fuentes de alimentación, sino que en forma independiente (sin cables).
Después de tener claro el funcionamiento y la forma en que debía moverse el OSO se
realizaron pruebas ya actuando sobre la línea obscura y regulando la velocidad de los motores.
Aquí las pruebas llevaron a la conclusión que el OSO debía tener una velocidad moderada para no
perder la línea. Se regulo el sistema de las ruedas para un mejor funcionamiento.
Recomendaciones a la solución
Una recomendación que puede hacerse, es que en este caso el OSO HORMIGUERO es
una versión mejorada del primero en su tipo, pudiéndose implementar con mayor éxito la etapa de
los sensores de choque.
Los rangos de operación del OSO son mentener un voltaje cercano a los 5 volt para el PIC
y las otras partes de los circuitos, y un voltaje de 3.6 volts para la etapa de potencia.
Las limitaciones son que la corriente no puede ser inferior a 1.5 amper por lo menos para
poder activar los motores en forma adecuada sin perder fuerza.
Conclusiones
La gran cantidad de aplicaciones que hoy en día nos presentan las diferentes familias de
microcontroladores hace de este trabajo un material de estudio importante para las personas que
quieren incursionar en el mundo de la robótica (microcontroladores Pic, microprocesadores, etc...),
de esta manera el estudio del problema, la implementación, y posterior puesta en marcha del
proyecto de acuerdo a los márgenes de tiempo establecidos es una perfecta herramienta para
estudiantes que al igual que nosotros deben realizar proyectos de trabajo similares a éste.
Como conclusión más técnica se puede decir que dentro del universo de microntroladores
PIC vistos por nosotros las variaciones con respectos a otras familias son bastante pequeñas, por
esta razón para alguien que alguna vez a trabajado con cualquier tipo de microprocesador o
microcontrolador podría también hacerlo con cualquier otro dispositivo similar sin ningún
problema.
Bibliografía y referencias
En los siguientes apartados se explicara con esquemas y programas algunas etapas que
pueden haber quedado poco claras en el informe.
Uno de los circuitos que se debiera explicar, es el driver de los motores, en este caso
explicaremos solo uno, ya que el otro es similar.
En este caso cuando el motor gira en un sentido, se activa un bit y el otro permanece en
cero. Como se puede ver siempre van ha estar trabajando, por ejemplo, el transistor de la derecha
PNP con el de la izquierda NPN.
Las puertas lógicas son alimentadas con 5 volts.
Es importante mencionar que este driver es solo de un motor, ya que para el otro motor es
similar. Las componentes están especificados en los apartados anteriores.
Circuito de los Sensores Infrarrojos
Se puede ver claramente la función del comparador y como se ingresan las señales al
comparador. Con este circuito se pudo implementar la etapa de sensado de la línea, las salidas
que en este caso son dos, una de cada sensor van directamente al microcontrolador, el cual las
ingresa como entradas para activar los motores.
CIRCUITO DEL ZUMBADOR:
En este punto se muestra un mapa de memoria del PIC 16C66, es importante destacar que este
microcontrolador posee más de un banco de memoria. En el caso del OSO HORMIGUERO, se
utilizó el primer banco. Con el registro STATUS, se puede configurar el banco a utilizar.
1Eh
1Fh
General Purpose 20h
register
96 Byte
CODIGO FUENTE
El siguiente programa muestra algo distinto al objetivo del robot, este programa hace que el OSO
esquive la línea negra y avance cuando encuentre algo blanco.
btfss Port_A,0
goto ADELANTE1
goto ATRAS1
btfss Port_A,1
goto ADELANTE2
goto ATRAS2
ADELANTE2 movlw b'00000010'
addwf PC ;sumar al contador de programa
nop ;si hubo algún sensor
nop ;presionado
movwf motor2 ;cargar valor en registro
goto SALTO1 ;leer sensor de nuevo
el siguiente programa lo que realiza, es implementar una rutina de choque dentro del programa
principal con el objetivo de hacer funcionar a estos sensores. Como se puede ver, dentro del
programa hay rutinas de retardo que son las encargas de dar un lapso de tiempo para que se
ejecuten las instrucciones.
reset org 0
goto INICIO
;************choque***********************