Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Robots Laberinto Grupo E PDF
Robots Laberinto Grupo E PDF
por
Noviembre 2006
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
NDICE
1.Introduccin......................................................................................................................... 4
3.Competiciones ..................................................................................................................... 7
Alcabot e Hispabot ............................................................................................................. 7
Micromouse ........................................................................................................................ 9
5.Sensores ............................................................................................................................. 16
Sensores de proximidad.................................................................................................... 18
Sensores de distancia ........................................................................................................ 19
6.Motores .............................................................................................................................. 21
Motores C.C. .................................................................................................................... 21
Motores paso a paso ......................................................................................................... 22
Servo motores ................................................................................................................... 22
7.Bateras .............................................................................................................................. 23
9.Simuladores ....................................................................................................................... 47
13.Catia................................................................................................................................. 61
Introduccin a Catia. ........................................................................................................ 61
Sketcher. ........................................................................................................................... 61
Part Desing ....................................................................................................................... 62
Assembly Dessing ............................................................................................................ 63
Diseo de nuestro robot. ................................................................................................... 63
Desarrollo por partes del diseo. ...................................................................................... 64
Base del robot. .............................................................................................................. 64
GP2D12. ....................................................................................................................... 64
Placa ............................................................................................................................. 65
Motor paso a paso......................................................................................................... 65
Bumper ......................................................................................................................... 66
CD ................................................................................................................................ 66
Aguja. ........................................................................................................................... 67
Sub-ensamblaje ................................................................................................................ 67
Montaje completo ............................................................................................................. 68
Pgina 2
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
15.Conclusiones. .................................................................................................................. 82
16.Bibliografa. ..................................................................................................................... 84
Pgina 3
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
1. INTRODUCCION
El documento desarrollado a continuacin trata sobre los Robots de laberinto o Robots
de Micromouse. El trabajo est desarrollado por un grupo de estudiantes de la UAH para
la asignatura de Microrrobots. El fin principal de este trabajo es aportar una base con la que
enfrentarse al desarrollo de un robot de laberinto.
Durante todo el texto abordamos diversos temas relacionados con este tipo de robots.
Para poder desarrollar el tema con la mayor sencillez y amplitud posible hemos dividido el
trabajo en varios aspectos.
Empezamos desarrollando el trabajo dando unas pinceladas de historia acerca de las
competiciones que se han realizado tanto a nivel nacional como internacional. Seguimos
con un anlisis de las estructuras ms usadas con sus ventajas e inconvenientes.
Obviamente necesitamos algn mtodo para salir del laberinto, esto lo abordamos en un
apartado dedicado exclusivamente a la algoritmia, control y simulacin. Para completar el
trabajo desarrollado hemos realizado una propuesta de diseo utilizando herramientas de
diseo en 3 dimensiones y llevando acabo el proyecto.
Finalmente aportamos unas conclusiones y consejos para que quien lo desee pueda
realizar un robot sin tener los mismos problemas que nos ocurrieron a nosotros.
Pgina 4
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
1977
En este ao se introdujo el concepto de microsmouse por el IEEE. En mayo se
anunci la primera competicin de Micromouse que sera celebrada en 1979 en
Nueva York.
1980
El profesor Juan Billinsley, de la escuela politcnica de Portsmouth, introdujo la
primera competicin europea y modific las reglas, consiguiendo que las
competiciones sean parecidas a las de la actualidad.
1981
En la exposicin micro de Pars hubo cinco micromouse, el primer lugar fue para
el ratn Esterlina, alcanzando la meta en menos de 3 minutos.
1985
Se llevo a cabo el First World Micromouse Competiton en Tsukuba, Japn.
1986
Los E.E.U.U. hicieron su primera competicin, celebrada en Atlantic City.
1987
Se produjo la primera competicin de Singapur
Pgina 5
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
1989
Se lanz la primera competicin internacional de Micromouse de Singapur.
1992
Tenemos ya la sptima entrega de competicin anual del micromouse de IEE, en
Londres.
Pgina 6
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
3. Competiciones
A continuacin presentamos las competiciones ms conocidas.
ALCABOT
o 2000
NORMATIVA: El concurso ser ganado por aqul micro-robot que
consiga salir del laberinto en el menor tiempo. Se dispone de una
nica entrada y una nica salida.
http://www.depeca.uah.es/alcabot/alcabot2000/normativa.htm
N PARTICIPANTES: 5
o 2001
NORMATIVA: El laberinto tiene una entrada y una salida y los
robots tienen que entrar en el laberinto y salir en el menor tiempo
posible.
http://www.depeca.uah.es/alcabot/alcabot2001/normativa.htm
N PARTICIPANTES PRESENTADOS: 10
o 2002
NORMATIVA: La prueba consistir en sacar al robot desde un punto
de partida conocido mediante sorteo, quince minutos antes del
comienzo de cada sesin. Podr salir por cualquiera de las dos
salidas del laberinto. El plano del laberinto es conocido para los
participantes.
http://www.depeca.uah.es/alcabot/alcabot2002/normas_laberinto.htm
N PARTICIPANTES PRESENTADOS: 35
o 2003
NORMATIVA: Coincide con Hispabot 2003. Es equivalente a la de
Alcabot 2002.
http://www.depeca.uah.es/alcabot/hispabot2003/laberinto.pdf
Pgina 7
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
N PARTICIPANTES PRESENTADOS: 12
o 2004
NORMATIVA: Se introducen novedades respecto aos anteriores:
Dado que el laberinto es conocido, se primar a los Robots
capaces de incorporar algoritmos de navegacin.
Las salidas del laberinto son dos: una de ellas ser vlida,
mientras que la otra tendr una penalizacin.
El Ratn obtendr bonificacin, si logra introducir una pelota
de ping-pong estndar en esa casilla central.
http://www.depeca.uah.es/alcabot/data/doc/HISPA04_Normativa_La
berinto_v1_0.pdf
Por lo dems la normativa es equivalente a la de los aos 2002 2003.
N PARTICIPANTES PRESENTADOS: 11
o 2006
NORMATIVA: Se introducen novedades respecto aos anteriores:
Rampa de entrada
Balizas.
Globos.
La canasta est en el exterior.
El mapa del laberinto no es conocido.
http://www.depeca.uah.es/alcabot/data/doc/HISPA06_Normativa_La
berinto_v2_1.pdf
N PARTICIPANTES PRESENTADOS: 4
HISPABOT
La normativa de cada ao de Hispabot es equivalente a la de Alcabot de cada ao
respectivamente.
Pgina 8
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
MICROMOUSE:
Acontecimientos similares tambin se llevan a cabo en los E.E.U.U, Japn, Singapur, Corea
y a otras partes. Los micromouses ratones compite con contra el reloj para buscar el
centro de un laberinto en el tiempo ms corto. El laberinto es desconocido.
N PARTICIPANTES: 11
Pgina 9
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
El chasis
El chasis es la estructura que sostiene y aporta rigidez y forma a nuestro robot. Un
buen smil sera el compararlo con el esqueleto humano. Por lo tanto queda justificada la
importancia de una correcta eleccin.
Forma
Imaginemos que hemos decidido hacer el robot con sensores de contacto, es decir, el
micromouse va por el laberinto, se choca contra una pared y da media vuelta. En este caso
la forma es importantsima puesto que tendremos que pensar en que el robot debe ser capaz
de girar sobre si mismo sin que la pared se lo impida, por ejemplo, con un cuadrado pasara
lo que vemos a continuacin:
Pgina 10
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Una buena solucin a esto podra ser no preocuparse de la forma del chasis, o no
preocuparse demasiado, y ms tarde colocar una carcasa externa con la forma que
queramos. Esta tcnica es la empleada por ejemplo por el robot PI:
http://www.rbzrobotdesign.com/index.php?module=3&id=21
Materiales
Las soluciones que se han ido viendo en las competiciones son muy variadas, por
ejemplo en el 2002 el robot AURELIO (a la derecha) utiliz
policarbonato diciendo que: este material es resistente, a la par
que ligero, permite ser cortado y troquelado sin presentar
problemas.
Pgina 11
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Grados de movimiento
Empezaremos viendo los dos tipos de movimiento que podemos tener, en funcin de
los grados de libertad en el giro.
BR3 MOUSE
Pgina 12
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
La traccin
Bsicamente la traccin nos importar en funcin del tipo de giro que proporcione.
Para ver el giro que necesita un robot debemos pensar en la funcin que va a desempear,
es decir, es posible que en ciertos casos necesitemos ms estabilidad que maniobrabilidad o
al contrario.
Existen muchos tipos de tracciones, pero en nuestro caso nos va a interesar
fundamentalmente solo una, por ello diferenciamos, a continuacin, dos tipos, la ms
utilizada y la que no debemos utilizar, explicando porqu:
Diferencial
Para el caso que nos ocupa (micromouse) podemos decir que en el 100% de
los robots premia la maniobrabilidad, y por este motivo utilizaremos una traccin
diferencial, gracias a esto conseguiremos hacer giros de 90-180 sin ninguna
complicacin.
Pgina 13
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
D
d= n
c
Donde:
d = distancia recorrida.
D = dimetro de la rueda.
c = nmero de pulsos del encoder por vuelta.
n = nmero de pulsos leidos.
Drueda 360
x= n
c Dbase
Donde:
x = grados girados.
Drueda = dimetro de la rueda.
Dbase = dimetro de la base tomando como limite de la
circunferencia el inicio de las ruedas.
c = nmero de pulsos del encoder por vuelta.
n = nmero de pulsos.
No diferencial
Por otro lado tenemos la traccin no diferencial, en la que las dos ruedas
giran a la vez y el tipo de giro es de la forma en que lo que movemos es un eje que
une ambas ruedas, producindose as el giro de estas.
Pgina 14
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Las ruedas
Antes de ponernos a montar las ruedas debemos ver dnde deben estar colocadas. En
principio podemos pensar en una colocacin equidistante en la base lo mas separadas
posible para mayor estabilidad, ahora bien, si lo hacemos as debemos tener en cuenta cual
ser el eje de giro, en este caso, significara que el robot no girar entorno al centro del
crculo que forma su planta y por tanto colisionar con el obstculo.
Pgina 15
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
http://www.sec.upm.es/agustin/charrito/charrito.html
Aqu vemos como las ruedas motrices estn colocadas de tal forma que el robot har
los giros sobre un punto distinto al centro de la base, en concreto, los giros sern los que
vemos en la figura siguiente:
Una forma sencilla de realizar giros sobre el centro de la base sera el adoptado por el
robot Pi de RBZ Robot Design, el cual, como vemos en la fotografa, utiliza dos ruedas
motrices colocadas en el dimetro de la base y dos ruedas locas para la estabilidad:
Pgina 16
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
El gran inconveniente de este tipo de solucin es que solo nos podremos mover por
zonas completamente lisas, ya que si una de las ruedas locas pasase por algn elevamiento,
por muy pequeo que fuera, alguna rueda motriz dejara de tocar el suelo.
Pgina 17
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
5. SENSORES
Los micromouse necesitan una manera de detectar las paredes dentro del laberinto,
esto lo harn mediante sensores. Distinguimos dos tipos: de proximidad simples o de
distancia.
Sensores de proximidad
Estos tipos de sensores nos dan informacin sobre si hay o no hay algo, es decir, nos
dan una seal binaria (verdadero o falso). Generalmente se montan en las alas de los
robots, de modo que puedan detectar las paredes mirando los techos de estas. Si hay una
pared directamente debajo del sensor, su valor ser verdadero, mientras que si no la hay el
valor ser falso. Un micromouse de este tipo tendra el siguiente aspecto:
Un diseo as tendr por lo menos siete sensores, uno mirando al frente y por lo
menos tres a cada lado. El sensor delantero evita que el ratn se estrelle con una pared
prxima al frente, mientras que los laterales permiten que el ratn corrija su trayectoria. En
el caso de la figura anterior, si los sensores izquierdos leen un valor de 010 indica que el
ratn est centrado dentro de la casilla. Si leemos un valor de 100, indicara que el ratn
est descentrado a la derecha y necesita corregir a la izquierda, y al contrario con un valor
001.
Pgina 18
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Usar este tipo de sensores tiene otra ventaja. Si por ejemplo leemos el sensor
derecho con un valor de 011, indicara que tenemos una pared perpendicular a la derecha
sin necesidad de desplazarnos a la correspondiente casilla, y por lo tanto invirtiendo menos
tiempo en la exploracin del laberinto
Sensores de distancia
Al contrario que los sensores de proximidad, los de distancia no devuelven un simple
verdadero/falso. Estos miden la distancia fsica entre el robot y la pared, y devuelven un
valor, el cual, el microcontrolador pueda interpretar como distancia.
Pgina 19
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Este sensor emiten una luz IR sobre la pared que es reflejada y recibida por el
dispositivo de deteccin de posicin (PSD). Dependiendo del ngulo de reflexin el
microcontrolador obtendr el correspondiente dato para poder actuar. Los sensores de este
tipo suelen ser ms inmunes a variaciones del color y de iluminacin.
Pgina 20
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
6. MOTORES
Los motores sern los encargados de generar los desplazamientos en el robot, por lo
tanto, la eleccin de estos ser algo determinante para conseguir un buen movimiento, tanto
en aceleracin como en velocidad punta.
Motores C.C.
En un motor C.C. la tensin se aplica directamente a los terminales de este
producindose el movimiento. Una vez polarizado, se alcanza, rpidamente, una velocidad
constante que depender dicho voltaje aplicado y de las caractersticas del motor. La
cantidad de fuerza que se puede generar ser funcin de la corriente por las bobinas, siendo
mayor al aumentar esta, es decir, si queremos generar una cierta velocidad, la corriente que
debemos generar ser mayor si el motor tiene una carga que si no.
Pgina 21
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Puente en H
La gran ventaja de estos motores es que no necesitamos usar encoders para controlar
el movimiento y saber donde estamos, es decir, seremos capaces de conocer en todo
momento la posicin sin ms que llevar un control de los pulsos aplicados.
Unipolares
Bipolares
Servo motores
Los servos se caracterizan por ser capaces de mantener cualquier posicin, dentro de
su intervalo de operacin, en funcin de la seal de entrada.
Pgina 22
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
HERTRON
7. Bateras
La bateras sern la alimentacin de nuestro robot, sin ellas nuestro robot no sera ms
que un amasijo de hierros que no servira para mucho, por eso habr que pensar
detenidamente cual ser el consumo para conseguir que en un futuro no nos encontremos
problemas como que la energa que tenemos no sea la suficiente. No obstante, un gran
inconveniente es el peso de las mismas, por lo que no conviene poner pilas de ms sino solo
las que sean necesarias.
8. Anlisis de algoritmia
Para abordar un estudio sobre la algoritmia usada en los robots de laberinto, vamos a
hacer una clasificacin basada en si el laberinto es o no conocido.
Pgina 24
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Se puede observar que dicho robot tiene codificado en memoria la situacin de los
muros horizontales y verticales. Adems, a cada celda le asigna un nmero que le indica la
distancia hasta la salida. De esta manera, en el momento que el robot localice su posicin,
deber desplazarse a la casilla con el nmero ms bajo. Este mtodo es muy utilizado, y
aunque existen diversas variantes, todos se basan en la misma idea:
Con los sensores de distancia, el robot puede detectar los muros a una casilla de
distancia en las cuatro direcciones, y memoriza la informacin.
Pgina 25
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Algoritmo de DIJKSTRA:
Cada uno de los puntos es un nodo, que en nuestro caso puede representar un cruce
del laberinto. El nodo de partida es a, y las distintas flechas nos muestran los posibles
caminos para ir de un nodo a otro, con su longitud.
Pgina 26
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Los nodos de color rojo son aquellos que podemos alcanzar desde el nodo inicial
a. La distancia desde a a esos nodos es b=4, d=85. De esta forma, b tiene la distancia
mnima al nodo inicial, ya que cualquier otro camino pasar por ms nodos, y por tanto ser
ms largo. A continuacin, b es coloreado de naranja para indicar que es el camino ms
corto.
Ahora las aristas rojas apuntan a los nodos que ya tienen una distancia final. Las
distancia desde a a los siguientes nodos es de c=22, d=85 y e=16. Como e es el camino
ms corto, lo coloreamos de naranja.
Pgina 27
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 28
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
En este caso la distancia a los nodos es d=82, f=42, h=49. La distancia a f ha vuelto
ha cambiado, ya que se ha encontrado otro camino ms corto a travs de los nodos b, c, j.
Coloreamos de naranja el nodo f, ya que tiene la distancia ms corta.
Las distancias son d=82, h=49, i=53. El nodo h tiene la distancia ms corta, as que
lo coloreamos de naranja.
Pgina 29
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
En esta situacin ya tenemos a la vista todos los nodos del ejemplo. Las distancias
son
d=82, g=51, i=53. Coloreamos de naranja el nodo g pues tiene la distancia mnima.
Pgina 30
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Por ltimo, solo nos queda el nodo d, con distancia d=63, as que lo coloreamos de
naranja, y por tanto el algoritmo ha finalizado.
http://alumnos.unican.es/uc900/Algoritmo.htm
Pgina 31
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Breadth first es un mtodo pensado para ser aplicado en grafos, pero tambin puede
ser utilizado en un laberinto conocindolo a priori ya que el funcionamiento de ambos es
similar. El mtodo breadth first empieza en un nodo X con un valor 0, en los nodos
circundantes se introducira el valor 1 y con los circundantes del 1 el valor 2, as hasta
completar todos los nodos, donde cada nodo se correspondera con una casilla del laberinto.
Paso 1 Paso 2
Paso 3 Paso 4
Paso 5 Paso 6
Paso 7 Paso 8
Paso 9
Pgina 32
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
http://www.personal.kent.edu/~rmuhamma/Algorithms/MyAlgorithms/GraphAlgor/breadth
Search.htm
Algoritmo de BELLMAN-FORD
www.cs.umu.se
Pgina 33
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Seguir la pared
A los laberintos que no contienen circuitos cerrados, tales como el laberinto que se
muestra en el siguiente dibujo, se les conoce como "simplemente conectados". Esto
equivale a decir que el laberinto no tiene muros separados. Los laberintos con muros
separados s contienen circuitos cerrados, y se les conoce como laberintos de "conexiones
mltiples"; un ejemplo es el siguiente laberinto.
http://www.astrolog.org/labyrnth/algrithm.htm
Pgina 34
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
SOLUCION
CAMINO RECORRIDO
SIN SALIDA
SIN RECORRER
http://www.astrolog.org/labyrnth/algrithm.htm
Llenar caminos
SOLUCION
CAMINO RECORRIDO
SIN SALIDA
SIN RECORRER
http://www.astrolog.org/labyrnth/algrithm.htm
Pgina 35
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Algoritmo aleatorio
http://www.ucy.ac.cy/~gracm05/PROCS1/10.pdf
Pgina 36
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Gaston Tarry y Edouard Lucas enumeraron una serie de pasos que debemos
implementar para conseguir resolver un laberinto si estamos dentro de l. Cuando entremos
por primera vez en un pasillo hay que dejar 2 marcas en la entrada. Cuando lleguemos a
una estancia, en la salida del pasillo haremos una marca si ya ha sido visto y en el caso de
que no lo hayamos visitado todava dejaremos 3 marcas. Siempre tenemos que elegir el
camino que no haya sido explorado o que posean una marca (que solo se hayan recorrido en
un sentido)
Recursividad
Pgina 37
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Funciones utilizadas:
Funcin vlida:
Se le pasa como datos de entrada la fila y la columna hacia donde se dirige y retorna un
valor booleado indicando si la posicin es correcta.
Algoritmo:
Funcin recorrer:
Retorna un valor buleano para as ver si se lleg o no al final, esta es la funcin que utiliza
la recursividad para moverse por el laberinto, los datos de entrada es la posicin actual
donde se encuentra y dentro de la funcin se pasa a si misma los valores en X e Y del
siguiente movimiento, marcando cada casilla por donde ha pasado para no retroceder e
intentando moverse primero a izquierdas, derechas, arriba y finalmente abajo pero
asegurndose antes que la casilla donde se mover ser vlida. La condicin de salida de
esta funcin es ver si se lleg a la salida o ver si nos encontramos en un callejn.
Algoritmo:
Devolver verdadera
Funcin main:
Encargado de visualizar el laberinto y la solucin y de llamar a la funcin recorrer
Algoritmo:
Algoritmo de Microtauro
El laberinto se considera como una gran matriz donde cada cuadrante de ste es una
casilla del array, cada pared se considera como un 1 y el lugar por donde no ha pasado el
robot se considera como 4. Cada vez que llega a una interseccin de 4 caminos transforma
el 4 en un 3(que significara que el robot puede pasar hasta 3 veces por esa casilla), cuando
se encuentra en un camino bidireccional lo transforma en un 2 (que significara que el robot
puede pasar hasta 2 veces) cuando se encuentra en un callejn al retroceder va
disminuyendo una unidad cada casilla entonces las casillas que tenan un 2 (ya que es un
pasillo) se transformar en 1, dejando as imposibilitado el paso ya que se tratara ahora de
una pared. Pero el robot no solo descuenta una unidad en los callejones, sino que lo hace a
medida que va avanzando, entonces si antes haba pasado por una casilla que tenan un
valor de 3 al pasar nuevamente, significar que ya solo puedo pasar 2 veces ms. Es decir,
el programa sabe por donde hemos pasado y por donde hay posibilidades de ir.
Pgina 39
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
El robot intenta dirigirse hacia el nmero ms alto que lo rodea pero en el caso de
que el nmero ms alto se repita, a la hora de elegir intenta ir por defecto a la derecha del
laberinto, ya que all se encuentra la salida, y a la hora de elegir entre ir arriba o abajo, no
teniendo la posibilidad de seguir avanzando hacia la salida, el robot reconoce en que
direccin se encuentra esta, calcula si se encuentra arriba o debajo de l y se dirige hacia
ella.
Pgina 40
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Diagonales
Recorrer el circuito en diagonal es una buena forma de ahorrar tiempo, pero tambin
es muy peligrosa. Los competidores expertos suelen estructurar sus diseos de tal forma
que sus robots puedan identificar y realizar tramos en diagonal, disminuyendo la longitud
total del recorrido y evitando as perder tiempo en realizar giros. Dependiendo de las
dimensiones de cada celda, nuestro laberinto tendr un ancho en diagonal determinado, que
en las pruebas de micromouse suele estar entorno a unos 110-130 mm, y por supuesto, el
robot deber ser ms estrecho que dicha longitud. Como es lgico, cuanto ms grande sea
nuestro robot, ms precisos deberemos ser, aunque tampoco interesa que el robot sea
demasiado estrecho, porque podramos tener problemas en curvas a velocidades altas. Por
ejemplo, si circulamos a una alta velocidad y realizamos un giro sobre una de las ruedas
para entrar en la diagonal, corremos el riesgo de que, por inercia, el cuerpo del robot se
desplace hacia uno de los lados. En definitiva: debemos disponer de una tolerancia mnima
que nos permita recorrer sin problemas el tramo de la diagonal, as como permitir pequeos
movimientos en torno a las posiciones calculadas. No es raro que durante la competicin
preliminar, muchos de los robots se choquen contra alguna de las esquinas del circuito.
Pgina 41
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
www.robots-dreams.com
Los sensores deben realizar trabajo extra en las diagonales. En el caso de usar
sensores laterales, ahora ya no disponemos de una superficie perpendicular de reflexin. La
variacin de distancia al muro es mayor y asimtrica, por lo que no podemos disponer de
informacin simultnea del lado derecho e izquierdo.
En lnea recta
Recorrer largos tramos rectos puede parecer sencillo, pero estamos seguros de que
el dimetro de las ruedas es el mismo (en el caso de usar motores paso a paso) o que los
bucles de control son los adecuados Qu ocurrira si nuestro robot llegase a chocar contra
una pared del laberinto? Para evitar esto, debemos tener en cuenta los distintos tipos de
errores que podemos cometer para poder actuar convenientemente. Corregir dichos errores
ser una labor necesaria para obtener unos buenos resultados. A continuacin se detallan
algunos de esos errores:
ERROR FRONTAL
http://micromouse.cannock.ac.uk/navigation/straights.htm
Pgina 42
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Error de distancia frontal: Se produce cuando nuestro robot se encuentra muy cerca
o muy lejos de la pared frontal. Este error es uno de los ms sencillos de corregir, ya que es
muy comn utilizar sensores de posicin que nos permiten realizar la calibracin con
suficiente antelacin. Sin embargo, algunos aspectos como la reflectividad de las distintas
paredes, la direccin e intensidad de la luz ambiental o simplemente la acumulacin de
otros errores, hace que no haya nada establecido sobre este proceso de recalibracin. Segn
[1] utilizar un sensor IR de corto alcance montado en la parte delantera del robot es un
mtodo muy preciso. Hay que tener mucho cuidado con acumular errores de este tipo. En el
peor de los casos, un error frontal de unos 2 cm cada 15 celdas representa un error del
0.7%, que puede ser suficiente para que se produzca una colisin al llegar a una curva. En
algunos casos, aunque no se haya producido colisin, tendremos un error de offset despus
de un giro de 90. En motores paso a paso, un error de ms o menos un paso representa un
error de unos 0.4 mm, que acumulado durante 15 celdas provoca un error de offset de unos
6 mm al realizar un giro. Este error debera ser corregible. En realidad, grandes
correcciones en el error frontal son sntoma de que hemos podido cometer errores graves en
otras partes del sistema de control del robot.
ERROR DE OFFSET
http://micromouse.cannock.ac.uk/navigation/straights.htm
Error de offset: Se produce cuando nos encontramos demasiado cerca o lejos de uno
de los muros laterales, y que aparece tras cometer un error de distancia frontal en un giro.
Para poder corregir este error, ser inevitable acumular un error frontal, ya que
recorreremos un tramo recto del laberinto en diagonal.
ERROR DE DIRECCIN
Pgina 43
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
http://micromouse.cannock.ac.uk/navigation/straights.htm
http://fribotte.free.fr/
Las curvas
El giro ms sencillo que puede hacer un robot se basa en hacer girar las ruedas en
sentido opuesto, y de esta manera rotar sobre su centro. Una vez que se tienen calibrados
los motores se pueden realizar giros de 90 y 180 con gran precisin. Los giros de 180
son necesarios cuando encontramos un camino sin salida y el robot no es bidireccional. Hay
que tener mucho cuidado con los momentos de inercia y para ello, sera conveniente
colocar la masa del robot lo ms cerca posible del centro, y si podemos reducir la masa del
robot, mucho mejor. Los sensores de los muros pueden aumentar de forma sorprendente el
momento de inercia en las ecuaciones, segn [1] en trminos de la distancia al centro al
cuadrado. Si se considera el giro sobre una sola rueda, hay que tener en cuenta que una de
las ruedas recorre ms distancia que la otra, y tal vez no sea provechoso en trminos de
velocidad, adems de que los problemas de inercia son peores en este tipo de giro.
Otro de los aspectos que permiten una velocidad alta en los robots de Micromouse
es el modo en el que se trazan las curvas del laberinto.
En un primer punto, vamos a centrar nuestra atencin en los giros de 180, lo cual
nos lleva a pensar en dos estrategias a seguir a la hora de trazarlos, estas estrategias son las
que vienen representadas en el dibujo inferior. Se puede observa que el dibujo de la
izquierda va asociado a un control ms rudimentario mientras que la forma de afrontar la
Pgina 44
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
http://www.robots-dreams.com
Una de las formas de poder mantener una velocidad tan considerable en un robot es
saber si la siguiente casilla a la que el robot va a acceder tiene o no pared. Para ello se va
obteniendo informacin por unos sensores colocados en la parte frontal del robot. Estos
sensores pueden ser de ultrasonidos o luminosos. Los sensores se colocan como se muestra
en la figura siguiente:
http://www.robots-dreams.com
Primeramente podemos ver que hay un sensor que apunta directamente hacia al
frente. Este sensor es, intuitivamente, sencillo de entender. Est colocado para poder
detectar posibles paredes situadas en celdas adyacentes. Esta estrategia de diseo hace tener
que obviar muchos posibles errores en la informacin enviada por los sensores, lo que hace
trabajar de forma aproximada.
Pgina 45
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
http://www.robots-dreams.com
En esta segunda imagen vemos como se comportan los sensores colocados de forma
oblicua. En un primer momento se puede llegar a pensar que la colocacin de los sensores
de esta forma es un poco intil, pero posicionando los 2 emisores con el mismo ngulo
permiten, como se puede observar en la figura, que el ngulo de incidencia y el de reflexin
es el mismo, y as poder conseguir tener informacin sobre paredes laterales en celdas
adyacentes.
De la experiencia de los distintos competidores de Micromouse, se llega a la
conclusin de que el ngulo ptimo para posicionar los sensores, no es de 45 sino un
ngulo algo menor.
Pgina 46
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
9. Simuladores
En relacin al apartado de simulacin, tras realizar una bsqueda por diferentes
sitios dentro de la Red que podemos hacer uso de diferentes herramientas para poder probar
los distintos algoritmos, es decir, existen soluciones comerciales para responder a tal
necesidad.
El laberinto consiste en un mapa de bits blancos y negros, donde los bits negros
representan las paredes. El robot deber desplazarse continuamente por el laberinto sin
chocarse con las paredes, utilizando para ello dos sensores de distancia colocados a +45 y -
45 con respecto a su eje longitudinal.
Pgina 47
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pero cada desarrollador de microrrobots, adems de poder usar soluciones como las
que se ofertan en MATLAB, se puede realizar su propio simulador mediante cualquier
herramienta de desarrollo, como puede ser el lenguaje C, JAVA, etc. En este trabajo se va a
proponer un posible simulador, implementada en lenguaje C, probndose sobre l, dos de
los algoritmos arriba explicados.
Simulamos los 2 mtodos que nos han parecido los ms destacados pos su sencillez
y eficacia:
Pgina 48
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 49
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
En nuestro caso las respuestas a estas preguntas no son del todo reales, ya que hemos
creado nuestra propia competicin a la que ajustar el robot. An as las respuestas son las
siguientes:
Una vez tenemos una base sobre la que poder trabajar debemos empezar a idear una
algoritmia, en nuestro caso y debido a la reutilizacin del microcontrolador debemos saber
que tenemos ciertos limites impuestos a priori. Una vez decidida la algoritmia, tendremos
que establecer los bloques necesarios para aportar datos suficientes al algoritmo, segn
sabemos los sensores que necesitamos realizamos una estructura inicial del robot que
permita manejar dichos sensores con un mnimo de garantas, es decir, que los pulsadores
estn colocados de forma estratgica o que los sensores de distancia estn dentro de su
margen de actuacin sin que se les impida en ningn momento su visin.
Pgina 50
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Dnde estamos?
Hacia dnde vamos?
Pgina 51
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Como podemos observar en la imagen anterior el robot no sabe hacia donde est
mirando, es por esto que almacenamos el laberinto con sus cuatro posibles orientaciones:
Pgina 52
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Una vez resuelto el problema de la orientacin nos queda por solucionar el problema
de la casilla de salida. Debido a que el laberinto esta formado por un campo de 9 celdas por
9 celdas lo mximo que podemos movernos hacia un lado u otro son 8 celdas, y debido a
que no queremos perder informacin haremos una matriz de 17 celdas por 17 celdas para
as aun saliendo desde una esquina podamos almacenar todos los datos en nuestra matriz
sin perder ningn valor, para ello empezaremos a guardar los datos desde el centro de la
matriz de datos:
Pgina 53
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
destacar que la celda central siempre es comn a cualquiera de los casos as que nuestra
bsqueda siempre partir desde la celda central.
El problema que se nos presenta en este caso es el uso de memoria RAM necesaria
para poder implementar el algoritmo.
Los mapas conocidos a priori se almacenarn siempre en memoria no voltil, de
forma que as siempre estarn disponibles y no ocuparan memoria RAM, es por esto que
necesitaremos nicamente memoria para la matriz de adquisicin de datos, esto implica un
tamao de memoria mnimo de 289 bytes disponibles en la memoria RAM.
Inicialmente las casillas tendrn el valor 0xFF para as poder diferenciar las que se
han recorrido y las que no. Cada byte tendr la siguiente estructura, vlida tanto para los
laberintos grabados inicialmente en ROM como para el que est en RAM:
Paredes referenciadas con el mapa hacia arriba BIT 7 BIT 6 BIT 5 BIT 6
Sin paredes 0 0 0 0
Pared abajo 0 0 0 1
Pared arriba 0 0 1 0
Pared izquierda 0 1 0 0
Pared derecha 1 0 0 0
Pared abajo y arriba 0 0 1 1
Pared arriba, izquierda, derecha 1 1 1 0
... ...
El algoritmo a seguir es bastante intuitivo, una vez que sabemos en que posicin
estamos lo nico que falta es encontrar un camino mnimo hasta la salida. Para ello
tendremos en cuenta el nmero de casillas hasta la salida, es decir, equivale a usar un mapa
en cualquier ciudad.
Pgina 54
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
De esta forma en cuanto sepamos donde estamos solo tenemos que consultar las
casillas que nos rodean y seleccionar la apropiada, pudiendo haber caminos que tengan la
misma distancia hacia la salida. Bien es cierto que en la figura anterior quizs fuese mejor ir
por el camino verde ya que tiene menos giros, en este caso si queremos que solo vaya por el
verde lo nico que deberamos hacer es cambiar el nombre la casilla que inicia el camino
rojo por una de mayor valor, de esta manera evitamos que seleccione ese camino.
Debido a la limitacin que tenemos en la memoria (lo que nos lleva a usar variables
tipo char y no tipo int) no podemos pasar de una distancia 15 la salida, esto nos hace andar
a ciegas durante unas cuantas casillas hasta encontrar casillas con valor menor a 15, en caso
de querer evitar esto deberamos usar variables de tipo int, por lo que necesariamente
tendramos que cambiar de microcontrolador. Como alternativa para no cambiar el micro
controlador es guardar en memoria ROM un mapa con valores y un mapa con las paredes.
Una vez adquirimos los datos debemos encontrar en que matriz la direccin del mapa
en la que estamos y con que orientacin nos encontramos, para ello la idea inicial que
tenemos es empezar a buscar comparando los datos que tenemos por filas, inicialmente
empezaremos a buscar por la casilla central de los datos recogidos tal y como se ha dicho
anteriormente, ya que es la nica celda que tenemos en comn, segn avancemos por el
laberinto iremos recopilando ms datos lo que nos lleva a descartar mapa por mapa y
encontrarnos. Para saber la direccin en la que estamos mirando llevaremos un historial de
los ndices de la matriz de las ltimas celdas recorridas sabiendo de donde venimos, si
aadimos a esto el nmero de giros dados sabemos hacia donde miramos.
Pgina 55
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 56
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
El cerebro
Todo robot que tiene que tomar decisiones de forma autnoma necesita un cerebro,
en este caso y por el motivo de aprovechar lo que tenemos hemos decidido usar un
68HC08 que reutilizamos de la prctica del laboratorio de SED de Ingeniera de
Telecomunicacin. Esto nos aporta la ventaja de que al menos alguno de los integrantes
del grupo conoce las herramientas de trabajo.
Microcontrolador de 8 bits
32Kbytes de memoria FLASH
512 bytes de memoria RAM
Velocidad de bus de hasta 8MHz
2 Timers de 16bits
ADC de 8 bits con 8 canales
Admite tanto lenguaje C como lenguaje Ensamblador
Hemos destacado estas caractersticas porque nos resulta necesario el tener un ADC
con una resolucin aceptable y al menos un temporizador.
Pgina 57
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
El sistema sensorial
Para saber en que posicin estamos en cada momento solo necesitamos tener 3
sensores de distancia, colocados de forma que sepamos la distancia hacia el frente,
derecha e izquierda. Con el fin de mejorar el posicionamiento de nuestro robot le
incluimos uno en la parte trasera.
Usamos como sensores de distancia unos GP2D12. Como ya sabemos son sensores de
distancia mediante infrarrojos, la medida que nos aporta estos sensores es una tensin
analgica con un rango de valores de 0.4V a 2.6V.
Con el fin de obtener una mejor resolucin usaremos un circuito que adapte la seal
de manera que amplificaremos de 2.6V a 5V, esto nos da una ganancia de 1.9. En el caso
de querer tener todava ms resolucin, la solucin es tan sencilla como bajar los 0.4V a 0
y luego amplificar
El problema que nos dan estos dispositivos es que distancias menores de 10cm las
medidas no son vlidas. Este inconveniente se tiene en cuenta ya en el diseo de la
estructura.
A los sensores de distancia se les suma un bumper delantero que nos indicara cuando
hemos pinchado un globo.
Los actuadotes
Obviamente necesitamos algn mecanismo que nos permita movernos por el
laberinto, para ello hemos credo conveniente utilizar motores paso a paso, ya que de esta
forma tenemos un control sobre el nmero de vueltas que llevamos dadas, as como giros
parciales con una gran exactitud.
Pgina 58
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Estructura fsica
Nuestra idea es realizar una base con forma elptica con el fin de tener suficiente
espacio, evitar esquinas y poder contener las ruedas dentro del permetro de la base,
Pgina 59
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
evitando as posibles roces con las paredes que podran hacer que el robot pasease a ser
un robot de escalada, llegando a volcar.
Los sensores los hemos colocado estratgicamente para poder conocer la posicin de
las paredes as como la posicin dentro de la celda. Adems en la parte frontal se han
colocado dos sensores, uno ms elevado que otro, el fin de colocar los sensores con esta
configuracin es detectar el globo. En la siguiente figura se demuestra el porque:
El resto de sensores se colocan formando un ngulo de 90 para ver todas las paredes
que nos rodean.
Con esta posicin de los sensores sabemos en cada momento la distancia en cada
pared, lo que nos indica si estamos posicionados correctamente dentro de la celda, as
podemos conseguir rectificar pequeos errores en el movimiento
Pgina 60
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
13. Catia.
Para disear el robot nos hemos ayudado del programa Catia, que nos permite realizar
un modelo en 3D, con todo tipo de medidas. Con ello conseguimos saber las cualidades que
va a tener nuestro robot antes de construirlo fsicamente.
Introduccin a Catia.
Catia tiene distintos mdulos, cada uno enfocados a distintos aspectos del diseo. Se
comienza con la generacin de figuras 2D(Sketcher), se crean slidos (Part Desing) y
finalmente se ensamblan(Assembly).
Hay otros muchos ms mdulos que permiten hacer un estudio fsico del producto
realizado, que dan datos sobre costes o precios y hasta pruebas de resistencia.
Debido a que el entorno de Catia era desconocido para todos nosotros, nos hemos
centrado en el modulo de diseo mecnico (Mecanical Desing).
Sketcher.
La base de todo diseo se realiza con esta herramienta. Su funcin es crear unos
planos 2D, que luego podremos dar volumen con la herramienta Part Desing.
Se pueden hacer todo tipo de formas (rectngulos, crculos, elipses, formas libres),
que luego se deben acotar implantando unas constraint. Las constraint son las medidas
de la figura 2d realizada. Es muy importante dar medidas correctas para que luego en el
ensamblado todo siga una misma escala.
Pgina 61
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Part Desing
Una vez que tenemos el plano 2D definido, hay que darle volumen. Con el Part
Desing podemos darle volumen, hacer agujeros a un volumen ya creado, rotar una pieza
para formar un volumen de revolucin, hacer contornos
No hay que olvidar que hay que seguir dando las medidas de la pieza que queremos
realizar, incorporando todas las constraints necesarias.
Pgina 62
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Hay veces que se necesitan volmenes que son iguales a otros ya creados, para no
volver a realizarlos nos ayudamos de herramientas de simetra, que mueven lo que hay
respecto a un eje de simetra (que define el usuario). Con ellos conseguimos piezas iguales
y simtricas.
Assembly Dessing
Herramienta en donde se unen todas las partes ya creadas. El desarrollo del
ensamblado debe ser ordenado y estructurado por sub-partes, es decir, no se debe intentar
montar todo el conjunto a la vez.
Una vez que aadimos al producto nuevo una de las partes ya hechas en el Part
Desing hay que ir agregando nuevas partes e irlas colocando. Para ello esta herramienta nos
presenta funciones para el movimiento en el espacio de las piezas y el asignamiento de
nuevas constraints.
Definir constraints en esta parte del ensamblado es muy importante. Aqu se definen
los mrgenes del producto creado. Seguir paralelismos, unir caras, unir ejes poco a poco
hacen que se cree un producto ordenado y exacto.
La exactitud es la principal caracterstica que nos brinca Catia, por lo que hay que
explotarla al mximo definiendo toda constraint que veamos necesaria.
El ensamblado final de los sub-ensamblados hay que realizarlo con especial cuidado,
uniendo todas las caras, siguiendo paralelismo(o perpendicularidades), siguiendo medidas,
etc. La precisin es importantsima, una pieza mal colocada o mal diseada nos puede
chocar con otro volumen. Catia da la posibilidad de ver todas las intersecciones de
piezas, con lo que podremos arreglar posibles fallos.
Primero se realizaron las primeras piezas simples (la base, los cds, los GP2D12).
En estos primeros pasos en el Sketcher y en el Part Desing se toma un primer contacto con
las herramientas, que hace que se coja soltura poco a poco.
En cada una de las partes creadas se ha utilizado una forma de dar volumen. No hay una
sola forma de crear una pieza. Por ejemplo, un cilindro puede hacerse como un rectngulo
Pgina 63
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
girado 360 sobre uno de sus lados o como una circunferencia a la que se le da volumen
vertical (u horizontal). De ah la gran posibilidad de diseos de piezas y figuras.
La base sigue una forma elptica, siguiendo los conceptos de estructuras estudiados.
Con esta forma conseguimos hacer los giros con mayor facilidad y evitar atascos con las
paredes. Las ruedas se incluyen dentro del permetro de la elipse base, para que no choquen
directamente contra la pared en caso de haber perdido la referencia. A continuacin se
muestran sus planos:
GP2D12.
Los sensores es una parte fundamental del robot. Se han diseado en catia siguiendo
las medidas de la hoja de caractersticas.
Pgina 64
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Placa
Es el cerebro de nuestro robot. Se ha diseado siguiendo las medidas de la placa
original. Con ello conseguimos saber perfectamente donde puede ser ensamblada y su
posicin ideal dentro del conjunto del robot.
Pgina 65
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
suelo para que las ruedas locas y los cds toquen el suelo sin perder la horizontalidad de la
base.
Bumper
Dispositivo que gracias a l sabremos si se a explotado el globo por contacto.
CD
Los cds nos servirn como ruedas de nuestro robot.
Pgina 66
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Aguja.
Elemento punzante que explotara el globo al contacto. Sencilla manera, pero
efectiva, de explotar los globos.
Sub-ensamblaje
El motor y los cds es una parte esencial que debe estar perfectamente alineada para
que el robot se mueva en linea recta. Para conseguir una mayor perfeccion y que el motor
izquerido tenga las mismas medidas que el derecho se ensamblo como un subconjunto, que
luego se unir al robot por duplicado. As se consigue un perfecto alineamiento.
Pgina 67
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Montaje completo
El montaje completo da una perfecta idea del robot a construir. Se ven todas las
piezas perfectamente definidas y su situacin dentro del conjunto.
Pgina 68
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 69
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Nuestro primer objetivo era que se moviesen los motores. Al utilizar motores paso a
paso necesitamos llevar una cuenta de los pasos dados, y controlando el tiempo entre
pasos podemos saber la velocidad. Entonces utilizamos uno de los Timer que tenemos, lo
configuramos para que interrumpa cada 3.33ms, de manera que configuramos el sistema
para dar un paso cada 6.66 ms.
Los sensores de distancia los muestreamos cada 100 pasos (cada media vuelta) de
forma continua. As tenemos referencias de todas las paredes cada poca distancia.
Para que nosotros podamos ver los datos hemos instalado un LCD de 4 lneas que nos
muestra los datos ofrecidos por los GP2 y el nmero de vueltas que han dado los motores
paso a paso.
#define ALANTE 0
#define ATRAS 1
#define DERECH 2
#define IZQUIERD 3
#define ARRIBA 4
#define ABAJO 5
#define SI 0
#define NO 1
void configTBM(void);
void configADC(void);
Pgina 70
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
void LCDdelay(void);
void Ctrl8bits(unsigned char codigo);
void Ctrl4bits(unsigned char codigo);
void Datos4bits(unsigned char dato);
void Config_LCD_4bits(void);
void printf_LCD_4bits(unsigned char fila, unsigned char columna, char *texto);
void convertir1 (unsigned char hexa);
char donde=ALANTE,moverse=SI,leer=ARRIBA,derecha=0,izquierda=0,arriba=0,abajo=0,atras=0;
unsigned char transformado1=48, transformado2=48, transformado3=48;
char pasos=0,vueltas=0,datosestables=NO;
void main(void) {
if(pasos>=200){
vueltas++;
pasos=0;
}
printf_LCD_4bits(1,1,"Pas:");
convertir1(pasos);
Datos4bits(transformado3);
Datos4bits(transformado2);
Datos4bits(transformado1);
printf_LCD_4bits(1,9,"Vuelt:");
convertir1(vueltas);
Datos4bits(transformado3);
Datos4bits(transformado2);
Datos4bits(transformado1);
printf_LCD_4bits(2,1,"Der:");
convertir1(derecha);
Datos4bits(transformado3);
Datos4bits(transformado2);
Datos4bits(transformado1);
printf_LCD_4bits(2,9,"Izq:");
convertir1(izquierda);
Datos4bits(transformado3);
Datos4bits(transformado2);
Datos4bits(transformado1);
printf_LCD_4bits(3,1,"Arr:");
convertir1(arriba);
Datos4bits(transformado3);
Datos4bits(transformado2);
Datos4bits(transformado1);
printf_LCD_4bits(3,9,"Abj");
convertir1(abajo);
Datos4bits(transformado3);
Datos4bits(transformado2);
Pgina 71
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Datos4bits(transformado1);
printf_LCD_4bits(4,1,"Atr:");
convertir1(atras);
Datos4bits(transformado3);
Datos4bits(transformado2);
Datos4bits(transformado1);
} /* loop forever */
}
void configTBM(void){
}
void configADC(void){
ADCLK_ADIV=3;//preescaler a 8
ADCLK_ADICLK=0; //coje reloj externo
ADSCR=0b01100000;//inicialmente mira el canal0
}
if(leer==DERECH){
derecha=ADR;//derecha+ADR;
ADSCR=0b01100001;
leer=IZQUIERD;
}
else if (leer==IZQUIERD){
izquierda=ADR;
ADSCR=0b01100010;
leer=ARRIBA;
}
else if (leer==ARRIBA){
arriba=ADR;
ADSCR=0b01100011;
leer=ABAJO;
}
else if (leer==ABAJO){
abajo=ADR;
ADSCR=0b01100100;
leer=ATRAS;
}
else if (leer==ATRAS){
atras=ADR;
ADSCR=0;
/*if(cont<=3){
cont=1;
datosestables=SI;
atras=atras/3; //hacemos la media de 3 muestras para que sean
mas estables
abajo=abajo/3;
arriba=arriba/3;
izquierda=izquierda/3;
derecha=derecha/3;
}
else {
ADSCR=0b01000000;
Pgina 72
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
leer=DERECH;
}*/
}
cuenta++;
if(cuenta>=2){ //2*3.33ms=6ms
cuenta=0;
if(moverse==SI){
pasos++;
paso++;
if(donde==ALANTE){
if(paso==1)
PTA=0x33; // OFF OFF ON ON
else if(paso==2)
PTA=0x66; // OFF ON ON OFF
else if(paso==3)
PTA=0xCC; // ON ON OFF OFF
else if(paso==4){
PTA=0x99; // ON OFF OFF ON
paso=0;
}
}
else if(donde==ATRAS){
if (paso==1)
PTA=0x33;
else if (paso==2)
PTA=0x99;
else if (paso==3)
PTA=0xCC;
else if (paso==4){
PTA=0x66;
paso=0;
}
}
else if(donde==DERECH){ //PARTE ALTA LA RUEDA DERECHA
if(paso==1)
PTA=0x33;
else if(paso==2)
PTA=0x96;
else if(paso==3)
PTA=0xCC;
else if(paso==4){
PTA=0x69;
paso=0;
}
}
else if(donde==IZQUIERD){//PARTE BAJOA RUEDA IZQUIERDA
if(paso==1)
PTA=0x33;
else if(paso==2)
PTA=0x69;
else if(paso==3)
PTA=0xCC;
else if(paso==4){
PTA=0x96;
paso=0;
}
Pgina 73
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
}
}
}
if(pasos>=100){
leer=DERECH;
datosestables=NO;
ADSCR=0b01100000;
/* derecha=0;
izquierda=0;
arriba=0;
abajo=0;
atras=0;*/
//ADSCR=0b01000001;
}
}
///////////////////////////////////LCD/////////////////////////////////////////////////////
if(hexa<=99){
transformado2=(hexa/0x0A)+48;//calculamos la decena con el cociente
transformado1=(hexa%0x0A)+48;//calculamos la unidad con el resto
transformado3=48; //Dejamos la centena como 0
}
else{
transformado1=(hexa%0x0A)+48;//calculamos unidades
transformado2=(hexa/0x0A);
transformado3=(transformado2/0x0A)+48; //calculamos centenas
transformado2=(transformado2%0x0A)+48; //calculamos decenas
}
}
void LCDdelay(void)
{
unsigned int j;
for(j=0;j<DelayTime;j++); // t > 40us (Tiempo de ocupaci el LCD)
}
LCDport = ((LCDport & 0xF0) | (codigo >> 4)); // Si est onectado a la parte
baja del puerto PTx[0:3]
RS = CONTROL;
E = ON;
E = OFF;
Pgina 74
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
LCDdelay();
LCDport = ((LCDport & 0xF0) | (codigo & 0x0F));//Si est onectado a la parte
baja del puerto PTx[0:3]
RS = CONTROL;
E = ON;
E = OFF;
LCDdelay();
}
LCDport = ((LCDport & 0xF0) | (dato >> 4)); // Si est onectado a la parte
baja del puerto PTx[0:3]
RS = DATOS;
E = ON;
E = OFF;
LCDdelay();
LCDport = ((LCDport & 0xF0) | (dato & 0x0F)); // Si est onectado a la parte
baja del puerto PTx[0:3]
RS = DATOS;
E = ON;
E = OFF;
LCDdelay();
}
void Config_LCD_4bits(void)
{
unsigned int cnt;
RS = 0;
E = 0;
Pgina 75
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
adrs = columna - 1;
if(fila == 2)
adrs = adrs | 0x40;
if(fila==3)
adrs = adrs | 0x94;
if(fila==4)
adrs =adrs | 0xD4;
Ctrl4bits(adrs | 0x80);
while(*texto)
Datos4bits(*texto++);
}
Para controlar los motores paso a paso hemos montado unos ULN2003A que
alimentamos con la tensin que queremos aplicar al motor paso a paso. La conexin se
realiza mediante unas resistencias de pull-up para aplicar mayor corriente a los motores.
La conexin de toda la electrnica realizamos mediante un cable plano que une la placa
del micro-controlador con una placa de grapin donde hemos soldados las conexiones.
Nos resulto imposible encontrar unos conectores para los GP2Y0A21. Por ello
grapinamos directamente los pines. Para darle un poco de rigidez y aislar un poco los
ruidos exteriores hemos usado tubo termo retrctil que aplicndole calor se encoge
adoptando la forma del contenido. Para mejorar la seal de entrada de los sensores
conectamos unos condensadores entre la tensin de salida y masa, evitando as el rizado
de la seal.
Pgina 76
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Inicialmente utilizamos una bandeja corriente que resulta un material muy duro, al
trabajar con el nos dimos cuenta que no lo suficientemente maleable como pensbamos
en un principio, aun as decidimos seguir trabajando con el debido a su dureza. Tras haber
montado los motores e intentar mover el robot nos encontramos con que el par del motor
no nos daba suficiente fuerza para arrancar el robot, intentando reparar este problema
aplicamos mayor potencial al motor paso a paso, aun as no conseguimos que arrancase,
asique decidimos quitar el material de la bandeja, ya que pesaba demasiado.
Adems de esto, para montar la estructura y darle rigidez hemos usado unos listones
de SAMBA, que resultan muy ligeros, por el contrario se astillan con mucha facilidad.
Para trabajar estos materiales usamos una sierra de calar, un taladro, una Dreamel,
lija, abrazaderas, cola blanca, tornillos, etc..
Pgina 77
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 78
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 79
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 80
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Componentes Precio
Bandeja x2 3
Madera de balsa 1,80
Rueda de plstico 0,94
Liston de SAMBA 2m 4,61
Tornillos 1,05
ULN2003 x4 2,5
Resistencias 10K x10 0,20
GP2Y0A21 x5 45,95
Placa de grapin 7
Motores paso a paso 0
Placa con micro controlador 0
Tubo Termo retrctil 0,95
Bobina de grapin 10
Estao 1
Cds/DVD 0
Bolsa de globos 0,90
Bumper ?
Discos de corte Dreamel 3
Zocalos x4 3,60
Aguja 0
Tornillos con tuerca 0,95
Condensadores de 100nf x10 0,60
TOTAL 88,05
Pgina 81
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
15. CONCLUSIONES
Las conclusiones que podemos sacar de las competiciones de Alcal son que la
participacin siempre a sido baja, incluso descendiendo en cada ao. Se ha visto que el
laberinto desconocido los participantes tenan muchos problemas para alcanzar la salida
por lo que en general, este, suele ser conocido.
Los participantes de las competiciones en general suelen tener luego una trayectoria
acadmica admirable, el participar en competiciones les da mucha experiencia en amplia
variedad de sectores, la robtica ayuda al estudiante a aumentar conocimientos para
posteriormente poder aplicarlos a sus estudios, o simplemente por joby.
Por ltimo vamos a hablar de las conclusiones que hemos sacado a la hora de
disear el robot.
Este ha sido el primer robot que hemos intentado montar. Nos hemos encontrado
con muchos problemas que a priori no pensbamos que podran ocurrir.
Para comenzar el diseo de nuestro robot pensamos en utilizar la herramienta Catia, ya que
pareca un programa muy intuitivo y que presentaba grandes resultados. Una vez que nos
pusimos con el desarrollo de las piezas surgen muchas dudas sobre planos, cortes y
superficies. Las herramientas de desarrollo en 2D son las usuales en todo programa grafico,
pero en cuanto se pasa al desarrollo 3D (Part Desing) todo es nuevo. Moverte en 3D no
resulta todo lo sencillo que pueda parecer, y equivocarte de ejes y superficies es algo
normal.
A la hora de montar todas las partes (Assembly Desing) ya se haba conseguido
tomar cierta familiaridad con el entorno lo que ya result algo menos costoso.
Por la falta de tiempo y el total desconocimiento del programa antes de la propuesta del
trabajo, solo hemos trabajado con la parte de diseo mecnico. Hay mltiples herramientas
dentro de Catia que podran habernos ayudado, incluso ms que la parte mecnica, ya que
el peso o el centro de gravedad bien definidos puede hacer un montaje mucho ms sencillo.
Como conclusin, es mejor trabajarse el diseo en Catia en todas sus posibilidades y luego
ponerse con el montaje.
Pgina 82
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
Pgina 83
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
16. Bibliografa.
Informacin relacionada con el algoritmo de Dijkstra:
http://www.alumnos.unican.es/uc900/Algoritmo.htm
ALGORITMOS FUNDAMENTALES VOL. I, Donald E.Knuth, EditorialRevert
S.A. 1985
http://www.cs.duke.edu/csed/jawaa/BFSanim.html
http://ccc.inaoep.mx/~emorales/Cursos/Busqueda04/node13.html
http://www.personal.kent.edu/~rmuhamma/Algorithms/MyAlgorithms/GraphAlgor/
breadthSearch.htm
http://www.ics.uci.edu/~eppstein/161/960215.html
http://micromouse.cannock.ac.uk/navigation/straights.html
[1]http://micromouse.cannock.ac.uk/navigation/straights.htm
http://www.robots-dreams.com/micromouse/index.html
http://www.aula-ee.com/webs/laberints/castella/res.htm
http://www.astrolog.org/labyrnth/algrithm.htm
http://www.ucy.ac.cy/~gracm05/PROCS1/10.pdf
Pgina 84
Introduccin al Diseo de Microrrobots Mviles Trabajos en Grupo
http://topo.math.u-
psud.fr/~slc/TeX/lcs/hodges/Graphs_HodgesWilfried/graphs001a.pdf
http://www.osti.gov/bridge/servlets/purl/10180101-GX4NXg/10180101.PDF
http://www2.ing.puc.cl/~iic11021/materia/ejemplos/maze.htm
Informacin complementaria:
http://www.depeca.uah.es
Informacin CATIA:
Pgina 85