Professional Documents
Culture Documents
NDICE
1. INTRODUCCIN
1.1.ANTECEDENTES ........................................................................................................2
1.2.OBJETIVO..................................................................................................................3
1.3.CONTENIDO DEL PROYECTO ......................................................................................3
2. HARDWARE
2.1.DISEO .....................................................................................................................5
2.1.1. Sensores..........................................................................................................5
2.1.1.1. Lnea ......................................................................................................8
2.1.1.2. Posicin ...............................................................................................13
2.1.1.3. Contacto...............................................................................................18
2.1.1.4. Deslizamiento ......................................................................................20
2.1.2. Etapa de potencia .........................................................................................23
2.1.3. Sistema de control ........................................................................................28
2.2.REALIZACIN PRCTICA .........................................................................................30
2.2.1. Tarjeta de acondicionamiento de sensores ...................................................31
2.2.2. Etapas de potencia........................................................................................35
2.2.3. Tarjeta de control .........................................................................................37
2.2.4. Montaje conjunto..........................................................................................39
2.3.ALIMENTACIN Y CONSUMOS .................................................................................40
2.3.1. Electrnica....................................................................................................41
2.3.2. Potencia ........................................................................................................42
3. SOFTWARE
43
4. CONCLUSIONES
50
5. BIBLIOGRAFA
51
1. INTRODUCCIN
El proyecto abordado consiste en el diseo y fabricacin robot autnomo destinado
a participar en las competiciones de robots Luchadores de sumo, cindose a la
normativa impuesta por el concurso Hispabot, cuya ltima revisin se adjunta como pliego
de condiciones.
1.1. ANTECEDENTES
La motivacin de realizar este proyecto surge de las caractersticas del mismo, ya
que integra una carga de trabajo elevada y la necesidad de aplicar diversidad de
conocimientos, junto con la gratificacin de tratarse de un proyecto de ejecucin, pudiendo
comprobarse prcticamente el resultado del mismo, y los requerimientos de trabajo en
equipo.
La idea inicial fue partir de un robot existente. El aspecto ms destacable de este
robot es el increble agarre logrado, sin embargo, se estimo oportuno aumentar la potencia
del mismo, as como reducir el elevado consumo de los motores, accionados por una etapa
de potencia a base de transistores MOSFET, permitiendo sustituir la pesada batera de
plomo empleada para alimentarlos por una ms ligera. Por otro lado, se decidi cambiar el
sistema de control por uno menos complejo y ms adecuado a las necesidades del robot, as
como reducir el tamao de los distintos elementos para conseguir un conjunto integrado y
ampliar, en lo posible, la informacin til recogida por el sistema sensorial. El robot en
cuestin puede observarse en la siguiente figura.
Las decisiones antes mencionadas llevaron al uso de cuatro motores en lugar de dos
y al uso de bateras de menor tamao, requirindose una modificacin completa del chasis,
lo que junto con el rediseo completo de los sistemas electrnicos desemboc en la
creacin de un robot completamente nuevo.
1.2. OBJETIVO
Se plantean como objetivos del proyecto la consecucin de un sistema sencillo,
acorde con las necesidades que surjan, altamente integrado en el conjunto mecnico y fcil
de programar; ajustndonos a ciertos mrgenes de disponibilidad de componentes, recursos
y coste.
Como objetivo de esta memoria, queda el representar una gua eficaz del proceso de
diseo y la ejecucin del sistema electrnico de un robot, pudiendo ser una referencia til
para el desarrollo de futuros proyectos.
2. HARDWARE
Denominamos hardware a la parte fsica o material de un sistema electrnico; para
su desarrollo es esencial conocer de forma detallada las funciones que este ha de cumplir,
as como el modo en que los datos deben fluir a travs del mismo. Para un robot autnomo,
como es el caso, es fcil identificar la necesidad de tres bloques dentro del mismo:
Un sistema sensorial que proporcione informacin del exterior.
Un sistema motor que permita reaccionar a los estmulos del sistema sensorial
(etapa de potencia).
Un sistema de control que reciba la informacin del exterior y la interprete de forma
adecuada para indicar como debe actuar el sistema motor.
La creacin de estos elementos ser descrita en dos fases: una primera fase de
diseo en la que se definirn los distintos componentes a emplear y las interconexiones de
los mismos (diseo de los circuitos), y una segunda fase de ejecucin o realizacin prctica
de los mismos que comprender su fabricacin e integracin en el sistema mecnico.
2.1. DISEO
Para el diseo de nuestro hardware partimos de una serie de ideas fundamentales u
objetivos que condicionarn el mismo y con los que se intentar ser coherentes en todo
momento; estas ideas podran resumirse en la bsqueda de un sistema sencillo, intuitivo,
de fcil programacin y un coste reducido.
2.1.1. SENSORES
Un sistema sensorial adecuado es fundamental para el correcto funcionamiento del
robot, entendiendo por adecuado que dicho sistema proporcione informacin suficiente y
5
Sensores de contacto, que nos informaran de cuando el oponente nos esta tocando y
por donde.
Sensores de deslizamiento, que nos indicarn si conseguimos avanzar en la
direccin deseada o por el contrario estamos siendo empujados o bloqueados.
Una vez definidos los cuatro grupos de sensores a emplear y la informacin que
deseamos obtener de ellos, procedemos, en los apartados siguientes, a definir el tipo y
numero concreto de elementos de cada uno y el diseo de las etapas de acondicionamiento
pertinentes.
2.1.1.1. LNEA
Para satisfacer la necesidad de detectar el color del suelo se emplearn sensores
pticos de infrarrojos de corto alcance. Los sensores de infrarrojos son empleados de forma
habitual en aplicaciones de robtica, existe constancia del buen resultado de los mismos y
su principio de funcionamiento es relativamente sencillo.
Los sensores de infrarrojos constan bsicamente de un emisor y un receptor de luz
infrarroja, generalmente colocados en paralelo, de ste modo, cuando un objeto se sita
ante ellos, el haz de luz emitido por el emisor es reflejado y captado por el receptor,
pudiendo determinarse la presencia o no de objetos ante l, como se muestra en la siguiente
figura.
Elegido el nmero, tipo y posicin de los sensores a emplear, nos decantamos por el
uso de sensores CNY70 debido a su extensin, bajo coste y pequeo tamao. Estos
sensores son pequeos dispositivos en forma de cubo en cuyo interior cuentan con un
diodo emisor de luz infrarroja de longitud de onda del orden de 950nm y un fototransistor
que acta de receptor situados en paralelo y apuntando en la misma direccin, de modo que
el fototransistor conducir ms cuanta ms luz se refleje contra su base. Estos dispositivos
exigen una distancia de unos 0.3mm a la superficie a detectar para obtener una buena
sensibilidad.
Para una correcta polarizacin del sensor, el diodo emisor debe conectarse entre
alimentacin y tierra, siendo necesario incluir una resistencia adicional con el fin de limitar
la corriente que pasa por el mismo y que este no se queme, pues nuestra tensin de trabajo
ser de 5V, estndar para este tipo de aplicaciones. Segn se indica en la hoja de
caractersticas, incluida en los anexos de este proyecto, la corriente a circular por el led no
debe ser superior a los 50mA, aunque tampoco es necesario alcanzar este valor; de este
modo, con la adicin de una resistencia de 330, la mencionada intensidad queda limitada
a unos 11mA, valor apropiado para este circuito.
10
5V
CNY 70
Vo
330
10K
Una vez polarizados adecuadamente los sensores, debemos crear los circuitos de
acondicionamiento pertinentes para hacer que la seal recibida por la tarjeta de control sea
lo ms clara, limpia y concisa posible. Puesto que el objetivo de estos sensores no ser otro
que avisar en el momento que alcancemos el borde del tatami, es obvio que no
necesitaremos distinguir entre un amplio espectro de colores, sino nicamente entre dos
estados, para ello convertiremos la seal analgica obtenida a la salida del sensor en una
seal lgica que emita 0 (0V) mientras el suelo sea de color negro, y 1 (5V) cuando este
pase a ser de color blanco.
Para realizar con transformacin descrita de la seal, la salida de cada CNY70 se
har llegar a un operacional configurado como comparador no inversor; es decir, ser
llevada al terminal positivo de un operacional, mientras que en el terminal negativo del
mismo se fijar una tensin de referencia, para lo que emplearemos un potencimetro de
500K, capaz de darnos suficiente precisin a la hora de obtener un valor adecuado para
11
5V
CNY 70
3
1/4 LM324
11
Vo
500K
330
10K
12
Las pruebas realizadas a los CNY70 revelaron que la tensin de salida obtenida ante
el color negro es siempre inferior a 0.5V, mientras que ante el color blanco siempre supera
los 3V, comprobndose que fijando una tensin de referencia en torno a los 1.5V se
obtiene un resultado ms que satisfactorio para nuestra aplicacin.
2.1.1.2. POSICIN
Se nos plantean distintas opciones para resolver el problema de localizar al robot
oponente durante el transcurso de un combate. Comenzaremos por analizar los principales
candidatos en cuanto al tipo de sensor.
La primera opcin planteada fueron los sensores de infrarrojos, aunque de un tipo
diferente al descrito anteriormente, mucho ms adecuado para esta aplicacin. Al igual que
los anteriores, este otro tipo de sensor de infrarrojos cuenta con un emisor y un receptor. La
luz emitida por un led infrarrojo pasa por una lente que concentra el haz en un nico rayo
lo ms concentrado posible, mejorando as la direccionalidad del sensor; esta rayo de luz
va recto hacia delante hasta que es reflejado por una superficie, rebotando con una cierta
inclinacin segn la distancia a la que esta se encuentre. La luz reflejada es concentrada de
nuevo por otra lente al retornar al dispositivo, de modo que todos los rayos inciden en un
nico punto del sensor de luz infrarroja que contiene la parte receptora del mismo; este
sensor es un CCD lineal, y dependiendo del ngulo de recepcin de la luz, esta incidir en
un punto u otro de dicho sensor, pudiendo de esta manera obtener un valor lineal y
proporcional al ngulo de recepcin del haz de luz, y por lo tanto a la distancia del objeto
que la ha reflejado.
13
La segunda opcin barajada eran los sensores por ultrasonidos. Los ultrasonidos son
vibraciones del aire de la misma naturaleza que el sonido audible pero de una frecuencia
mas elevada, superior a 20000Hz, no audibles por el odo humano. Estos sensores, al
igual que los anteriores, se componen de un emisor y un receptor; el primero emite
impulsos de ultrasonidos que viajan a gran velocidad hasta alcanzar un objeto, entonces el
sonido es reflejado y captado de nuevo por el receptor de ultrasonidos. Comnmente llevan
un controlador incorporado que hace al emisor lanzar una rfaga de impulsos, y a
continuacin empieza a contar el tiempo que tarda en llegar el eco, el cual ser
proporcional a la distancia a la que se encuentre el objeto. De forma habitual, la seal
obtenida como salida del sensor consiste en un pulso de eco de anchura proporcional a la
distancia a la que se encuentra la superficie que lo ha reflejado.
A pesar de contar este ltimo tipo de sensores con un alcance y precisin bastante
superior a los primeros, nos decantamos por el uso de sensores de infrarrojos, ya que su
funcionamiento es mucho mas sencillo, as como la interpretacin de la salida que
producen, siendo adems su coste notablemente menor. Por otro lado, no requerimos un
alcance demasiado elevado, dado el tamao del rea de combate, y en cuanto a la
precisin, concluimos que para nuestra aplicacin, analizar la distancia a la que se
encuentra el obstculo no nos proporcionara grandes ventajas en cuanto a las posibles
respuestas del robot, y sin embargo complicara de forma acusada la programacin del
mismo.
Llegados a este punto, se plantean multitud de opciones en cuanto a la posicin y
nmero de elementos a emplear, pasando por la posibilidad de usar incluso uno slo
montado sobre un soporte giratorio, opcin descartada por implicar el uso un encoder para
determinar la orientacin en el momento de la lectura y un sistema mecnico ms
complejo, teniendo por otro lado en cuenta que el coste de estos sensores no es elevado,
por lo que el uso de varios de los mismos no alcanzar costes prohibitivos.
Finalmente optamos por el uso de ocho sensores situados de forma que queden
cubiertas las cuatro diagonales del robot segn se muestra en la figura de la pgina
siguiente.
14
15
Los sensores elegidos cuentan con un conector de tres pines destinados a los
siguientes propsitos:
Pin 1: tensin de salida.
Pin 2: conexin a tierra.
Pin 3: conexin a alimentacin (5V).
17
5V
3
2
1
Vo
3 +
2 -
1/4 LM324
11
Sharp
500K
2.1.1.3. CONTACTO
A la hora de detectar el contacto con el robot oponente parece adecuado el uso de
algn tipo de pulsador mecnico. Entre la infinidad de este tipo de elementos que es
posible encontrar en el mercado, nos decidimos por el uso de finales de carrera por su
sistema de accionamiento, disponibilidad y sensibilidad. Un final de carrera no es ms que
un conmutador de dos posiciones con una palanca de accionamiento y un muelle de retorno
a la posicin de reposo, en la que permanecer salvo cuando este siendo pulsado.
18
10K, que har las veces de pull-up y pull-down, entre el terminal comn del fin de carrera
y la entrada de nuestra tarjeta de control, limitando as la corriente que llegar a esta
ltima.
El circuito para cada uno de los sensores de contacto se muestra a continuacin. El
circuito completo para los cuatro elementos se adjunta en el captulo de planos.
5V
Final de carrera
Vo
10K
2.1.1.4. DESLIZAMIENTO
Una vez alcanzado el contacto frontal con el oponente, y con el fin de saber si
estamos consiguiendo nuestro objetivo de empujarle o por el contrario estamos siendo
empujados o bloqueados, pondremos en juego lo que hemos denominado sensor de
deslizamiento. Para cumplir esta funcin, y puesto que conocemos nuestro sentido de
movimiento, el mtodo ms intuitivo es aadir una rueda adicional independiente de la
traccin de nuestro robot sobre la que podamos leer su sentido de giro y as compararlo con
el avance pretendido.
Para determinar el sentido de giro de esta rueda adicional se nos plantean diversas
opciones, que van desde el uso de un encoder comercial hasta la creacin de nuestro propio
sistema, pasando por la extraccin del mecanismo de un ratn de ordenador. La primera
opcin, el uso de un encoder comercial, fue inmediatamente descartada debido a su
elevado coste.
A grandes rasgos, el funcionamiento del encoder de un ratn se basa en la
interposicin de un disco perforado entre dos emisores de infrarrojos y sus dos receptores
correspondientes, de modo que al girar interrumpe a impulsos la conexin entre estos.
20
21
22
5V
Vo1
3 +
CNY 70
2 4
1/2 LM358
500K
Vo2
5 +
10K
6 -
1/2 LM358
4
330
500K
motores, adaptando la seal enviada por la primera y consiguiendo que los segundos se
encienda o apaguen y giren en uno u otro sentido.
La necesidad de usar esta etapa intermedia radica en la escasa capacidad para
suministrar corriente de la tarjeta de control, que por si sola no sera capaz de mover los
motores. El mtodo ms sencillo para lograr la intensidad requerida es mediante el uso de
un transistor de cierta potencia funcionando como un interruptor controlado por la seal
lgica emitida, es lo que comnmente llamamos driver de corriente; de este modo, el
circuito digital slo enciende y apaga el transistor, siendo este el que enciende y apaga el
motor.
Por otro lado, tenemos que la mayor parte de los dispositivos electromecnicos son
inductivos, como es el caso de los motores, por lo que la corriente en ellos no puede variar
de forma instantnea, tendiendo a mantener durante unos instantes la corriente en
circulacin tras la apertura del circuito, pudiendo generarse una chispa capaz de daar el
elemento que realiz la desconexin. Para evitar esto, se aade un diodo de proteccin a
fin desahogar la corriente residual producida por el elemento inductivo.
El sistema descrito es suficiente para mover los motores, pero no para nuestro
sistema de traccin, en el que han de poder girar en ambos sentidos, hacindose necesario
el uso de puentes H. El puente H es un circuito basado en el uso de cuatro interruptores que
debe su nombre a su forma, y que habilitan el paso de la corriente en los dos sentidos a
travs del elemento al que se conectan en funcin del estado de los mismos. En la figura
siguiente se muestra un esquema bsico de un puente H.
Como hemos dicho, el uso de estos circuitos nos permitir invertir la corriente en
los motores, permitindonos cambiar su sentido de giro sin necesidad de recurrir a voltajes
negativos. Su funcionamiento es muy sencillo, ya que como puede observarse,
permaneciendo A y D cerrados y B y C abiertos, la corriente circula en un sentido,
mientras que si mantenemos abiertos los primeros y cerrados los segundos, el sentido esta
ser opuesto.
En la figura siguiente se muestran las dos posibilidades de funcionamiento descritas
sobre un puente H construido con transistores MOSFET.
Llegado el momento de disear esta etapa debemos tomar como punto de partida las
caractersticas de los motores que debemos alimentar, de los cuales sabemos que tienen
una tensin nominal de 12V y un consumo a plena carga no superior a los 1.5A. Estas
caractersticas hacen innecesario el uso de puentes de fabricacin propia aptos para el
manejo de intensidades muy elevadas, ya que se encuentran en el mercado dispositivos
adecuados a nuestras necesidades. A continuacin puede verse una imagen del tipo de
motor empleado.
Antes de proseguir, ntese que nuestro robot cuenta con cuatro motores, mientras
que el L298 slo esta capacitado para accionar dos de estos, es por ello que utilizaremos
dos circuitos completos como el que se describe ms adelante, uno para los motores de
cada lado.
Sin entrar en demasiados detalles, mencionar que el L298 cuenta con dos entradas
de control y dos salidas para la carga en cada canal, conexin a tierra, alimentacin para la
lgica, y alimentacin para la salida, adems de un terminal de control para la corriente y
otro de encendido en cada canal. En la figura 26, mostrada en la pgina siguiente, puede
comprobarse la correspondencia de estos pines.
26
Puesto que en ningn momento haremos girar los dos motores del mismo lado en
sentidos opuestos, es innecesario el uso de cuatro seales de control para manejarlos, por lo
que ser cortocircuitado el pin 5 con el 10 y el 7 con el 12. Los pines 6 y 11, destinados a
encender o apagar cada puente H, sern igualmente cortocircuitados y llevados hasta la
tarjeta de control junto con los anteriores .El pin 8 quedar puesto a tierra, al igual que el 1
y el 15, pues no deseamos monitorizar ni limitar la corriente de la carga. El pin 9 quedar
conectado a alimentacin de 5V, y al 4 se har llegar la tensin de la batera destinada a
alimentar los motores, de la que hablaremos en el apartado correspondiente. Finalmente,
entre los pines 2 y 3 por un lado, y 13 y 14 por otro, sern conectados los motores con sus
correspondientes puentes de diodos de proteccin. El circuito resultante se muestra en la
siguiente figura.
5V
Vbat
L298
Vi1
Enable
Vi2
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
Motor1
Motor2
La tabla de verdad para el control de los motores a travs del circuito diseado se
adjunta a continuacin.
Enable
Vi1
Vi2
Detenidos
Giro en sentido 1
Giro en sentido 2
Desconectados
Desconectados
28
29
GND
Power
Reset
I/O 15 Lnea 4
I/O 1
I/O 14 Lnea 3
I/O 2
10
I/O 13 Lnea 2
11
I/O 3
12
I/O 12 Lnea 1
13
I/O 4
14
I/O 11 Contacto 4
15
I/O 5
16
I/O 10 Contacto 3
17
I/O 6 Desliz. 1
18
I/O 9 Contacto 2
19
I/O 7 Desliz. 2
20
I/O 8 Contacto 1
21
+5V
22
+5V
23
GND
24
GND
25
I/O 16 DirM1 1
26
I/O 31 Posicin 8
27
I/O 17 EnableM2
28
I/O 30 Posicin 7
29
I/O 18 EnableM1
30
I/O 29 Posicin 6
31
I/O 19 DirM1 2
32
I/O 28 Posicin 5
33
I/O 20 DirM2 1
34
I/O 27 Posicin 4
35
I/O 21 DirM2 2
36
I/O 26 Posicin 3
37
I/O 22
38
I/O 25 Posicin 2
39
I/O 23
40
I/O 24 Posicin 1
30
31
LM7805
Vin
Vo = 5V
3
0.1uF
0.1uF
C. Lnea
C. Deslizamiento
C. Posicin 1
Alimentacin
C. Contacto
C. Posicin 2
C. Tarjeta de
Control
32
1Izq.
Polarizacin Lnea 1
2Izq.
Polarizacin Lnea 2
3Izq.
Polarizacin Lnea 4
4Izq.
Polarizacin Lnea 3
Contacto 1
Contacto 2
Contacto 3
Contacto 4
Posicin 1
Posicin 2
Posicin 3
Posicin 4
Posicin 8
Posicin 7
Posicin 6
Posicin 5
Salida Deslizamiento
Polar. Deslizamiento
33
Deslizamiento 2
Deslizamiento 1
Posicin 2
Posicin 1
Posicin 4
Posicin 3
Contacto 1
Contacto 2
Contacto 4
10
Contacto 3
11
Posicin 7
12
Posicin 8
13
Posicin 5
14
Posicin 6
15
Lnea 1
16
Lnea 2
17
Lnea 4
18
Lnea 3
Ajuste ref.
Deslizamiento 1
Ajuste ref.
Deslizamiento 2
Ajuste ref.
Posicin
Ajuste ref.
Lnea
34
35
cuando las fuentes de tensin no se hallan lo suficientemente cerca del circuito como para
garantizar su estabilidad.
Las limitaciones de tamao impuestas por el diseo del conjunto mecnico
obligaron a reducir el tamao de las etapas a tarjetas de 57x36mm. En la siguiente figura se
muestra un esquema de las tarjetas resultantes; el esquema de los circuitos electrnicos as
como los planos del circuito impreso pueden consultarse en la seccin de planos.
Conexin
motor A
Alimentacin
motores
Tierra
Conexin
motor B
Sense A
Direccin A 1
Enable A
Direccin A 2
Tierra
+5V
Enable B
Direccin B 1
Sense B
10
Direccin B 2
36
37
No se incluyeron los conectores destinados a servos por igual motivo que el punto
anterior.
La resistencia de pull-up situada en la lnea de interrupcin externa fue suprimida
para habilitar el uso de esta para otra funcin.
El resultado final de la tarjeta montada segn estas indicaciones y su incorporacin
al conjunto puede verse en las siguientes imgenes.
Para la programacin de esta tarjeta a travs de del bus I2C fue necesaria la
fabricacin de un cable especfico cuyo esquema puede consultarse en el apartado de
planos. Al comienzo de la siguiente pgina puede observarse una imagen del mencionado
cable de programacin.
38
39
40
2.3.1. ELECTRNICA
En la siguiente tabla se muestra un resumen de los consumos de la parte electrnica.
Tngase en cuenta que tarjeta de acondicionamiento excluye la polarizacin de los
sensores, incluyndose esta en el consumo del respectivo sensor.
Cantidad
Consumo (mA)
Subtotal (mA)
CNY70
12
48
Sharp GP2Y0A21YK
40
320
Sensor de contacto
S. de deslizamiento
12
12
T. Acondicionamiento
30
30
T. Control
100
100
Etapa de potencia
40
80
Total
670 mA
Tabla 10: Consumos de la electrnica.
Debido a la tensin mnima requerida por los reguladores de tensin se opt por el
uso de pilas de 9V para la alimentacin de la electrnica, evitando la necesidad de poner
elementos en serie. Por otro lado, teniendo en cuenta que la capacidad de estas pilas es del
orden de 500mA/h y que contamos con un margen de peso razonable, se hace interesante el
uso de dos pilas en paralelo, obteniendo una autonoma mnima de unos 90 minutos.
41
2.3.2. POTENCIA
El ensayo de carga realizado a los motores de 12V empleados revel un consumo de
cada uno de los mismos de aproximadamente 1.2A en mxima carga, con lo que el
consumo mximo de las cuatro unidades en conjunto resulta de unos 4.8A, no siendo
significativa la influencia de las etapas de potencia debido a su alto rendimiento.
Para la alimentacin de los motores se opt, por razones de ahorro de peso
principalmente, por el uso de bateras recargables de in de litio, emplendose cuatro
elementos de 3.6V y 1600mA/h conectados en serie, obtenindose 14.4V a su salida y una
autonoma mnima de veinte minutos.
42
3. SOFTWARE
La programacin del dispositivo se realizo a travs del bus I2C de la tarjeta de
control, conectado al puerto paralelo del ordenador, mediante el uso de una sencilla
herramienta de desarrollo distribuida en www.oopic.com que permite el uso de los
lenguajes Basic, Java y C.
Para la creacin del programa se hizo uso de diversos recursos otorgados por el
sistema OOPic. El concepto de OOPic es simple, en el microcontrolador de la tarjeta se
encuentran programados una serie de objetos destinados a interactuar con el hardware en
segundo plano, mientras el cdigo cargado en la EEPROM los controla. Toda la
informacin sobre OOPic, los objetos que emplea, etc. se encuentra detallada en su pgina
web.
2
4
3
2
7
1
8
4
Asimismo se defini como sentido de avance 1 el que queda al lado izquierdo segn
la figura, y como sentido 2 el que queda a la derecha; y se llam motores 1 a la pareja de la
parte superior, mientras que los del lateral que queda en la parte inferior de la misma se
designaron como motores 2.
Al inicio, el programa comienza asignando a los objetos correspondientes a
procurarnos el estado de los sensores sus respectivas lneas de entrada, seguidas de las
pertinentes para accionar las lneas de salida para el control de los motores. Para controlar
el sentido de giro de cada pareja de motores se emplean dos lneas del modo que se ha
descrito anteriormente; adems se emplea una lnea adicional para la activacin y control
de velocidad de cada grupo.
El control de velocidad de los motores se realizar por PWM (Pulse Width
Modulation). Este sistema consiste en accionar los motores mediante una seal cuadrada
de alta frecuencia cuyo ancho de pulso es variable, permitindonos controlar el valor eficaz
de la onda.
Una vez definidos las entradas y salidas se introduce una demora de cinco segundos
segn las normas del concurso, tras lo cual se procede a realizar una sacudida del robot a
fin de desplegar las planchas a ambos lados del mismo antes de iniciar los eventos que
definen el funcionamiento del programa.
Los eventos son pequeos subprogramas con capacidad para interrumpirse unos a
otros segn un orden de prioridades. La activacin de estos eventos se encuentra ligada a la
salida de una serie de circuitos virtuales, un recurso de OOPic que permite programar
circuitos que actan como si de un circuito fsico se tratase, operando constantemente
44
mientras se encuentran activos; de este modo, se ligo cada evento a travs de una puerta
lgica OR a los elementos del grupo de sensores que lo disparan. Los eventos empleados
fueron:
Lnea: Cuando se activa comprueba los sensores de lnea de uno en uno,
provocando el alejamiento de la lnea con una curva leve en la direccin ms
adecuada en cada caso. ste es el evento con mayor prioridad, por lo que puede
interrumpir cualquier otra actuacin del robot por razones lgicas.
Contacto: Una vez activado comienza por comprobar los sensores uno y tres; en
caso de estar alguno de ellos activo, se procede al avance a plena potencia en el
sentido que corresponda, se almacena el estado del sensor de deslizamiento, y se
compara con el estado actualizado en otra variable peridicamente durante un
segundo. Durante este segundo, si en algn momento se detecta retroceso, se
procede con una secuencia de huida, al igual que si pasado ese segundo no hemos
conseguido avanzar. Posteriormente se comprueban los sensores dos y cuatro,
procedindose con la rutina de huida correspondiente al contacto lateral en su caso.
Este evento es el segundo en prioridad, pues las reacciones que genera son
prioritarias sobre las de reorientacin.
45
Inicio
Asignacin de lneas de E/S
Espera de 5 segundos
Realizar sacudida
Activar evento Avance
46
Evento Lnea
Lnea 1?
Sentido=2
Avance con curva abierta a la izquierda
Sentido=2
Avance con curva abierta a la derecha
Sentido=1
Avance con curva abierta a la izquierda
Sentido=1
Avance con curva abierta a la derecha
Lnea 2?
N
Lnea 3?
N
Lnea 4?
N
47
Evento Contacto
Contacto 1?
Sentido=1
Avance en lnea recta
N
Se ha retrocedido o no
conseguido avanzar en
1 segundo?
S
Sentido=2
Secuencia de huida
Contacto 3?
Sentido=2
Avance en lnea recta
N
Se ha retrocedido o no
conseguido avanzar en
1 segundo?
S
Sentido=1
Secuencia de huida
Contacto 2?
Conservar Sentido
Secuencia de huida
Conservar Sentido
Secuencia de huida
Contacto 4?
N
48
Evento Posicin
Posicin 1?
Sentido=1
Giro cerrado a la izquierda
Sentido=1
Giro cerrado a la derecha
Sentido=1
Avance con curva a la izquierda
Sentido=1
Avance con curva a la derecha
Sentido=2
Giro cerrado a la izquierda
Sentido=2
Giro cerrado a la derecha
Sentido=2
Avance con curva a la izquierda
Sentido=2
Avance con curva a la derecha
N
Posicin 4?
N
Posicin 2?
N
Posicin 3?
N
Posicin 5?
N
Posicin 8?
N
Posicin 6?
N
Posicin 7?
N
49
4. CONCLUSIONES
La realizacin de este proyecto ha constituido una labor de gran esfuerzo y trabajo
continuado por parte de los proyectistas involucrados. La importante tarea de
documentacin requerida, la puesta en prctica de los conocimientos obtenidos a lo largo
de la carrera y la necesidad de adquirir algunos nuevos, junto con la ejecucin del mismo y
el trabajo en equipo implicado, hacen de este un proyecto excepcional a nivel de formacin
y experiencia.
Por otro lado, el proyecto representa una importante entrada en el mundo de los
sistemas de deteccin y actuacin y la interrelacin de los mismos; sistemas que se
extienden desde la robtica hasta la automocin pasando por la domtica, haciendo
funcionar los elementos cotidianos ms insospechados.
Los resultados obtenidos con el prototipo en lo referente a la mecnica fueron ms
que satisfactorios, logrndose una potencia y un agarre elevados, adems de un peso
controlado y un tamao reducido. En cuanto a la electrnica, se alcanzaron holgadamente
los objetivos planteados, pues el buen funcionamiento de los sistemas sensoriales y etapas
de potencia habilitan el robot para una actuacin eficaz; resultando adems un sistema
fcilmente programable y perfectamente integrado en el conjunto mecnico.
50
5. BIBLIOGRAFA
Microelectronic circuits, Adel S. Sedra y Kenneth C. Smith. Oxford University
Press. 1998.
Diseo Electrnico y Construccin de un Robot Autnomo, Noem Leonato
Prez. ICAI Universidad Pontificia Comillas, 2004
http://www.depeca.uah.es/alcabot/hispabot2004/
http://www.superrobotica.com/
http://www.x-robotics.com/
http://www.junun.org/
http://www.oopic.com
51