Documentos de Académico
Documentos de Profesional
Documentos de Cultura
por
Noviembre 2006
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
ÍNDICE
1.Introducción......................................................................................................................... 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.Baterías .............................................................................................................................. 23
9.Simuladores ....................................................................................................................... 47
13.Catia................................................................................................................................. 61
Introducción a Catia. ........................................................................................................ 61
Sketcher. ........................................................................................................................... 61
Part Desing ....................................................................................................................... 62
Assembly Dessing ............................................................................................................ 63
Diseño de nuestro robot. ................................................................................................... 63
Desarrollo por partes del diseño. ...................................................................................... 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
— Página 2 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
15.Conclusiones. .................................................................................................................. 82
16.Bibliografía. ..................................................................................................................... 84
— Página 3 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
1. INTRODUCCION
El documento desarrollado a continuación 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 análisis de las estructuras más usadas con sus ventajas e inconvenientes.
Obviamente necesitamos algún método para salir del laberinto, esto lo abordamos en un
apartado dedicado exclusivamente a la algoritmia, control y simulación. Para completar el
trabajo desarrollado hemos realizado una propuesta de diseño utilizando herramientas de
diseño 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.
— Página 4 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
1977
En este año se introdujo el concepto de microsmouse por el IEEE. En mayo se
anunció la primera “competición de Micromouse” que sería celebrada en 1979 en
Nueva York.
1980
El profesor Juan Billinsley, de la escuela politécnica de Portsmouth, introdujo la
primera competición europea y modificó las reglas, consiguiendo que las
competiciones sean parecidas a las de la actualidad.
1981
En la exposición micro de París hubo cinco micromouse, el primer lugar fue para
el ratón Esterlina, alcanzando la meta en menos de 3 minutos.
1985
Se llevo a cabo el “First World Micromouse Competiton” en Tsukuba, Japón.
1986
Los E.E.U.U. hicieron su primera competición, celebrada en Atlantic City.
1987
Se produjo la primera competición de Singapur
— Página 5 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
1989
Se lanzó la primera competición internacional de Micromouse de Singapur.
1992
Tenemos ya la séptima entrega de competición anual del micromouse de IEE, en
Londres.
— Página 6 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
3. Competiciones
A continuación presentamos las competiciones más conocidas.
ALCABOT
o 2000
NORMATIVA: El concurso será ganado por aquél 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 sesión. 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
— Página 7 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Nº PARTICIPANTES PRESENTADOS: 12
o 2004
NORMATIVA: Se introducen novedades respecto años anteriores:
• Dado que el laberinto es conocido, se primará a los Robots
capaces de incorporar algoritmos de navegación.
• Las salidas del laberinto son dos: una de ellas será válida,
mientras que la otra tendrá una penalización.
• El Ratón obtendrá bonificación, si logra introducir una pelota
de ping-pong estándar en esa casilla central.
http://www.depeca.uah.es/alcabot/data/doc/HISPA04_Normativa_La
berinto_v1_0.pdf
Por lo demás la normativa es equivalente a la de los años 2002 2003.
Nº PARTICIPANTES PRESENTADOS: 11
o 2006
NORMATIVA: Se introducen novedades respecto años 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 año de Hispabot es equivalente a la de Alcabot de cada año
respectivamente.
— Página 8 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
MICROMOUSE:
Acontecimientos similares también se llevan a cabo en los E.E.U.U, Japón, Singapur, Corea
y a otras partes. Los micromouses “ratones” compite con contra el reloj para buscar el
centro de un laberinto en el tiempo más corto. El laberinto es desconocido.
Nº PARTICIPANTES: 11
— Página 9 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
El chasis
El chasis es la estructura que sostiene y aporta rigidez y forma a nuestro robot. Un
buen símil sería el compararlo con el esqueleto humano. Por lo tanto queda justificada la
importancia de una correcta elección.
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 importantísima 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 pasaría
lo que vemos a continuación:
— Página 10 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Una buena solución a esto podría ser no preocuparse de la forma del chasis, o no
preocuparse demasiado, y más tarde colocar una carcasa externa con la forma que
queramos. Esta técnica 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.”
— Página 11 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Grados de movimiento
Empezaremos viendo los dos tipos de movimiento que podemos tener, en función de
los grados de libertad en el giro.
BR3 MOUSE
• Movimiento en línea recta: este tipo de movimiento será mucho más sencillo
de realizar que el diagonal, pero a cambio los desplazamientos serán más
lentos al tener que recorrer más distancia. Con este tipo, nos podemos
encontrar problemas como que alguna rueda patine o que los giros no sean
exactamente de 90-180º haciendo al robot tener un error acumulativo que
puede tener graves consecuencias si no lo corregimos.
— Página 12 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
La tracción
Básicamente la tracción nos importará en función del tipo de giro que proporcione.
Para ver el giro que necesita un robot debemos pensar en la función que va a desempeñar,
es decir, es posible que en ciertos casos necesitemos más 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 continuación, dos tipos, la más
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 tracción
diferencial, gracias a esto conseguiremos hacer giros de 90-180º sin ninguna
complicación.
— Página 13 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
π ⋅D
d= ⋅n
c
Donde:
d = distancia recorrida.
D = diámetro de la rueda.
c = número de pulsos del encoder por vuelta.
n = número de pulsos leidos.
Drueda ⋅ 360
x= ⋅n
c ⋅ Dbase
Donde:
x = grados girados.
Drueda = diámetro de la rueda.
Dbase = diámetro de la base tomando como limite de la
circunferencia el inicio de las ruedas.
c = número de pulsos del encoder por vuelta.
n = número de pulsos.
• No diferencial
Por otro lado tenemos la tracción 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, produciéndose así el giro de estas.
— Página 14 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Las ruedas
Antes de ponernos a montar las ruedas debemos ver dónde deben estar colocadas. En
principio podemos pensar en una colocación 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, significaría que el robot no girará entorno al centro del
círculo que forma su planta y por tanto colisionará con el obstáculo.
— Página 15 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
http://www.sec.upm.es/agustin/charrito/charrito.html
Aquí vemos como las ruedas motrices están colocadas de tal forma que el robot hará
los giros sobre un punto distinto al centro de la base, en concreto, los giros serán los que
vemos en la figura siguiente:
Una forma sencilla de realizar giros sobre el centro de la base sería el adoptado por el
robot Pi de RBZ Robot Design, el cual, como vemos en la fotografía, utiliza dos ruedas
motrices colocadas en el diámetro de la base y dos ruedas locas para la estabilidad:
— Página 16 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
El gran inconveniente de este tipo de solución es que solo nos podremos mover por
zonas completamente lisas, ya que si una de las ruedas locas pasase por algún elevamiento,
por muy pequeño que fuera, alguna rueda motriz dejaría de tocar el suelo.
— Página 17 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
5. SENSORES
Los micromouse necesitan una manera de detectar las paredes dentro del laberinto,
esto lo harán mediante sensores. Distinguimos dos tipos: de proximidad simples o de
distancia.
Sensores de proximidad
Estos tipos de sensores nos dan información sobre si hay o no hay algo, es decir, nos
dan una señal 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 tendría el siguiente aspecto:
Un diseño 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 ratón se estrelle con una pared
próxima al frente, mientras que los laterales permiten que el ratón corrija su trayectoria. En
el caso de la figura anterior, si los sensores izquierdos leen un valor de 010 indica que el
ratón esté centrado dentro de la casilla. Si leemos un valor de 100, indicaría que el ratón
está descentrado a la derecha y necesita corregir a la izquierda, y al contrario con un valor
001.
— Página 18 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Usar este tipo de sensores tiene otra ventaja. Si por ejemplo leemos el sensor
derecho con un valor de 011, indicaría 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 exploración 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 física entre el robot y la pared, y devuelven un
valor, el cual, el microcontrolador pueda interpretar como distancia.
— Página 19 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Este sensor emiten una luz IR sobre la pared que es reflejada y recibida por el
dispositivo de detección de posición (PSD). Dependiendo del ángulo de reflexión el
microcontrolador obtendrá el correspondiente dato para poder actuar. Los sensores de este
tipo suelen ser más inmunes a variaciones del color y de iluminación.
— Página 20 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
6. MOTORES
Los motores serán los encargados de generar los desplazamientos en el robot, por lo
tanto, la elección de estos será algo determinante para conseguir un buen movimiento, tanto
en aceleración como en velocidad punta.
Motores C.C.
En un motor C.C. la tensión se aplica directamente a los terminales de este
produciéndose el movimiento. Una vez polarizado, se alcanza, rápidamente, una velocidad
constante que dependerá dicho voltaje aplicado y de las características del motor. La
cantidad de fuerza que se puede generar será función 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.
— Página 21 —
Introducción al Diseño de Microrrobots Móviles 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 posición sin más que llevar un control de los pulsos aplicados.
• Unipolares
• Bipolares
Servo motores
Los servos se caracterizan por ser capaces de mantener cualquier posición, dentro de
su intervalo de operación, en función de la señal de entrada.
Para el caso que nos ocupa, quizá lo más práctico sería utilizarlo
tras haberle quitado los topes y la electrónica encargada de mantener la
posición, es decir, lo usaremos como un motor de continua, siendo estos
baratos y con buenas prestaciones.
— Página 22 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
HERTRON
7. Baterías
La baterías serán la alimentación de nuestro robot, sin ellas nuestro robot no sería más
que un amasijo de hierros que no serviría 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 energía 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 más sino solo
las que sean necesarias.
La tabla siguiente enumera algunas de las características más típicas de los tipos más
populares de baterías:
8. Análisis de algoritmia
Para abordar un estudio sobre la algoritmia usada en los robots de laberinto, vamos a
hacer una clasificación basada en si el laberinto es o no conocido.
— Página 24 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Se puede observar que dicho robot tiene codificado en memoria la situación de los
muros horizontales y verticales. Además, a cada celda le asigna un número que le indica la
distancia hasta la salida. De esta manera, en el momento que el robot localice su posición,
deberá desplazarse a la casilla con el número más bajo. Este método 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 información.
— Página 25 —
Introducción al Diseño de Microrrobots Móviles 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.
— Página 26 —
Introducción al Diseño de Microrrobots Móviles 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
mínima al nodo inicial, ya que cualquier otro camino pasará por más nodos, y por tanto será
más largo. A continuación, b es coloreado de naranja para indicar que es el camino más
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
más corto, lo coloreamos de naranja.
— Página 27 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 28 —
Introducción al Diseño de Microrrobots Móviles 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 más corto a través de los nodos b, c, j.
Coloreamos de naranja el nodo f, ya que tiene la distancia más corta.
Las distancias son d=82, h=49, i=53. El nodo h tiene la distancia más corta, así que
lo coloreamos de naranja.
— Página 29 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
En esta situación 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 mínima.
— Página 30 —
Introducción al Diseño de Microrrobots Móviles 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
— Página 31 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Breadth first es un método pensado para ser aplicado en grafos, pero también puede
ser utilizado en un laberinto conociéndolo a priori ya que el funcionamiento de ambos es
similar. El método breadth first empieza en un nodo X con un valor 0, en los nodos
circundantes se introduciría el valor 1 y con los circundantes del 1 el valor 2, así hasta
completar todos los nodos, donde cada nodo se correspondería con una casilla del laberinto.
Paso 1 Paso 2
Paso 3 Paso 4
Paso 5 Paso 6
Paso 7 Paso 8
Paso 9
— Página 32 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Entonces el primero que llegue al nodo de destino será el camino más corto y la
solución a nuestro laberinto. Entonces lo único que resta es volver siguiendo los números
inmediatamente inferiores para volver a la casilla de inicio.
http://www.personal.kent.edu/~rmuhamma/Algorithms/MyAlgorithms/GraphAlgor/breadth
Search.htm
Algoritmo de BELLMAN-FORD
www.cs.umu.se
— Página 33 —
Introducción al Diseño de Microrrobots Móviles 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
múltiples"; un ejemplo es el siguiente laberinto.
http://www.astrolog.org/labyrnth/algrithm.htm
— Página 34 —
Introducción al Diseño de Microrrobots Móviles 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
— Página 35 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Algoritmo aleatorio
http://www.ucy.ac.cy/~gracm05/PROCS1/10.pdf
— Página 36 —
Introducción al Diseño de Microrrobots Móviles 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 todavía 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
— Página 37 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Funciones utilizadas:
Función “válida”:
Se le pasa como datos de entrada la fila y la columna hacia donde se dirige y retorna un
valor booleado indicando si la posición es correcta.
Algoritmo:
Función recorrer:
Retorna un valor buleano para así ver si se llegó o no al final, esta es la función que utiliza
la recursividad para moverse por el laberinto, los datos de entrada es la posición actual
donde se encuentra y dentro de la función 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
asegurándose antes que la casilla donde se moverá será válida. La condición de salida de
esta función es ver si se llegó a la salida o ver si nos encontramos en un callejón.
Algoritmo:
Devolver verdadera
Función main:
Encargado de visualizar el laberinto y la solución y de llamar a la función 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 intersección de 4 caminos transforma
el 4 en un 3(que significaría que el robot puede pasar hasta 3 veces por esa casilla), cuando
se encuentra en un camino bidireccional lo transforma en un 2 (que significaría que el robot
puede pasar hasta 2 veces) cuando se encuentra en un callejón al retroceder va
disminuyendo una unidad cada casilla entonces las casillas que tenían 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 había pasado por una casilla que tenían un
valor de 3 al pasar nuevamente, significará que ya solo puedo pasar 2 veces más. Es decir,
el programa sabe por donde hemos pasado y por donde hay posibilidades de ir.
— Página 39 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
El robot intenta dirigirse hacia el número más alto que lo rodea pero en el caso de
que el número más 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
dirección se encuentra esta, calcula si se encuentra arriba o debajo de él y se dirige hacia
ella.
— Página 40 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Diagonales
Recorrer el circuito en diagonal es una buena forma de ahorrar tiempo, pero también
es muy peligrosa. Los competidores expertos suelen estructurar sus diseños 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 más estrecho que dicha longitud. Como es lógico, cuanto más grande sea
nuestro robot, más precisos deberemos ser, aunque tampoco interesa que el robot sea
demasiado estrecho, porque podríamos 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 mínima
que nos permita recorrer sin problemas el tramo de la diagonal, así como permitir pequeños
movimientos en torno a las posiciones calculadas. No es raro que durante la competición
preliminar, muchos de los robots se choquen contra alguna de las esquinas del circuito.
— Página 41 —
Introducción al Diseño de Microrrobots Móviles 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 reflexión. La
variación de distancia al muro es mayor y asimétrica, por lo que no podemos disponer de
información simultánea del lado derecho e izquierdo.
En línea recta
Recorrer largos tramos rectos puede parecer sencillo, pero ¿estamos seguros de que
el diámetro 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é ocurriría 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 continuación se detallan
algunos de esos errores:
ERROR FRONTAL
http://micromouse.cannock.ac.uk/navigation/straights.htm
— Página 42 —
Introducción al Diseño de Microrrobots Móviles 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 más sencillos de corregir, ya que es
muy común utilizar sensores de posición que nos permiten realizar la calibración con
suficiente antelación. Sin embargo, algunos aspectos como la reflectividad de las distintas
paredes, la dirección e intensidad de la luz ambiental o simplemente la acumulación de
otros errores, hace que no haya nada establecido sobre este proceso de recalibración. Según
[1] utilizar un sensor IR de corto alcance montado en la parte delantera del robot es un
método 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 colisión al llegar a una curva. En
algunos casos, aunque no se haya producido colisión, tendremos un error de offset después
de un giro de 90º. En motores paso a paso, un error de más 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 debería ser corregible. En realidad, grandes
correcciones en el error frontal son síntoma 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 DIRECCIÓN
— Página 43 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
http://micromouse.cannock.ac.uk/navigation/straights.htm
http://fribotte.free.fr/
Las curvas
El giro más 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 precisión. 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, sería conveniente
colocar la masa del robot lo más 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, según [1] en términos 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 más distancia que la otra, y tal vez no sea provechoso en términos de
velocidad, además 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 atención 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 más rudimentario mientras que la forma de afrontar la
— Página 44 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
curvas según el dibujo de la derecha presenta un control más depurado, ofreciendo así
mejores prestaciones.
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 información 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 diseño hace tener
que obviar muchos posibles errores en la información enviada por los sensores, lo que hace
trabajar de forma aproximada.
— Página 45 —
Introducción al Diseño de Microrrobots Móviles 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 colocación de los sensores
de esta forma es un poco inútil, 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 reflexión
es el mismo, y así poder conseguir tener información sobre paredes laterales en celdas
adyacentes.
De la experiencia de los distintos competidores de Micromouse, se llega a la
conclusión de que el ángulo óptimo para posicionar los sensores, no es de 45º sino un
ángulo algo menor.
— Página 46 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
9. Simuladores
En relación al apartado de simulación, tras realizar una búsqueda 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.
— Página 47 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Pero cada desarrollador de microrrobots, además 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, probándose sobre él, dos de
los algoritmos arriba explicados.
Simulamos los 2 métodos que nos han parecido los más destacados pos su sencillez
y eficacia:
— Página 48 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 49 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
En nuestro caso las respuestas a estas preguntas no son del todo reales, ya que hemos
creado nuestra propia competición a la que ajustar el robot. Aún 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 reutilización 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, según
sabemos los sensores que necesitamos realizamos una estructura inicial del robot que
permita manejar dichos sensores con un mínimo de garantías, es decir, que los pulsadores
estén colocados de forma estratégica o que los sensores de distancia estén dentro de su
margen de actuación sin que se les impida en ningún momento su visión.
— Página 50 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
• ¿Dónde estamos?
• ¿Hacia dónde vamos?
— Página 51 —
Introducción al Diseño de Microrrobots Móviles 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:
— Página 52 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Una vez resuelto el problema de la orientación 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 máximo que podemos movernos hacia un lado u otro son 8 celdas, y debido a
que no queremos perder información 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 ningún valor, para ello empezaremos a guardar los datos desde el centro de la
matriz de datos:
— Página 53 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
destacar que la celda central siempre es común a cualquiera de los casos así que nuestra
búsqueda 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 almacenarán siempre en memoria no volátil, de
forma que así siempre estarán disponibles y no ocuparan memoria RAM, es por esto que
necesitaremos únicamente memoria para la matriz de adquisición de datos, esto implica un
tamaño de memoria mínimo de 289 bytes disponibles en la memoria RAM.
Inicialmente las casillas tendrán el valor 0xFF para así poder diferenciar las que se
han recorrido y las que no. Cada byte tendrá la siguiente estructura, válida 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 posición
estamos lo único que falta es encontrar un camino mínimo hasta la salida. Para ello
tendremos en cuenta el número de casillas hasta la salida, es decir, equivale a usar un mapa
en cualquier ciudad.
— Página 54 —
Introducción al Diseño de Microrrobots Móviles 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 quizás 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 deberíamos 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 limitación 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 deberíamos usar variables de tipo int, por lo que necesariamente
tendríamos 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 dirección del mapa
en la que estamos y con que orientación 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 común, según avancemos por el
laberinto iremos recopilando más datos lo que nos lleva a descartar mapa por mapa y
encontrarnos. Para saber la dirección en la que estamos mirando llevaremos un historial de
los índices de la matriz de las últimas celdas recorridas sabiendo de donde venimos, si
añadimos a esto el número de giros dados sabemos hacia donde miramos.
— Página 55 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 56 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
El cerebro
Todo robot que tiene que tomar decisiones de forma autónoma necesita un “cerebro”,
en este caso y por el motivo de aprovechar lo que tenemos hemos decidido usar un
68HC08 que reutilizamos de la práctica del laboratorio de SED de Ingeniería de
Telecomunicación. 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 características porque nos resulta necesario el tener un ADC
con una resolución aceptable y al menos un temporizador.
— Página 57 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
El sistema sensorial
Para saber en que posición 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 tensión
analógica con un rango de valores de 0.4V a 2.6V.
Con el fin de obtener una mejor resolución usaremos un circuito que adapte la señal
de manera que amplificaremos de 2.6V a 5V, esto nos da una ganancia de 1.9. En el caso
de querer tener todavía más resolución, la solución 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 válidas. Este inconveniente se tiene en cuenta ya en el diseño de la
estructura.
A los sensores de distancia se les suma un bumper delantero que nos indicaría cuando
hemos pinchado un globo.
Los actuadotes
Obviamente necesitamos algún mecanismo que nos permita movernos por el
laberinto, para ello hemos creído conveniente utilizar motores paso a paso, ya que de esta
forma tenemos un control sobre el número de vueltas que llevamos dadas, así como giros
parciales con una gran exactitud.
— Página 58 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Estructura física
Nuestra idea es realizar una base con forma elíptica con el fin de tener suficiente
espacio, evitar esquinas y poder contener las ruedas dentro del perímetro de la base,
— Página 59 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
evitando así posibles roces con las paredes que podrían hacer que el robot pasease a ser
un robot de escalada, llegando a volcar.
Los sensores los hemos colocado estratégicamente para poder conocer la posición de
las paredes así como la posición dentro de la celda. Además en la parte frontal se han
colocado dos sensores, uno más elevado que otro, el fin de colocar los sensores con esta
configuración 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 posición 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 pequeños errores en el movimiento
— Página 60 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
13. Catia.
Para diseñar 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 físicamente.
Introducción a Catia.
Catia tiene distintos módulos, cada uno enfocados a distintos aspectos del diseño. Se
comienza con la generación de figuras 2D(Sketcher), se crean sólidos (Part Desing) y
finalmente se ensamblan(Assembly).
Hay otros muchos más módulos que permiten hacer un estudio físico 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 diseño mecánico (Mecanical Desing).
Sketcher.
La base de todo diseño se realiza con esta herramienta. Su función es crear unos
planos 2D, que luego podremos dar volumen con la herramienta Part Desing.
Se pueden hacer todo tipo de formas (rectángulos, círculos, 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.
— Página 61 —
Introducción al Diseño de Microrrobots Móviles 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 revolución, hacer contornos…
No hay que olvidar que hay que seguir dando las medidas de la pieza que queremos
realizar, incorporando todas las constraints necesarias.
— Página 62 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Hay veces que se necesitan volúmenes que son iguales a otros ya creados, para no
volver a realizarlos nos ayudamos de herramientas de simetría, que mueven lo que hay
respecto a un eje de simetría (que define el usuario). Con ellos conseguimos piezas iguales
y simétricas.
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 añadimos 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 márgenes 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 característica que nos brinca Catia, por lo que hay que
explotarla al máximo 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 precisión es importantísima, una pieza mal colocada o mal diseñada 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 cd’s, 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 rectángulo
— Página 63 —
Introducción al Diseño de Microrrobots Móviles 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 diseños de piezas y figuras.
La base sigue una forma elíptica, 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 perímetro de la elipse base, para que no choquen
directamente contra la pared en caso de haber perdido la referencia. A continuación se
muestran sus planos:
GP2D12.
Los sensores es una parte fundamental del robot. Se han diseñado en catia siguiendo
las medidas de la hoja de características.
— Página 64 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Placa
Es el “cerebro” de nuestro robot. Se ha diseñado siguiendo las medidas de la placa
original. Con ello conseguimos saber perfectamente donde puede ser ensamblada y su
posición ideal dentro del conjunto del robot.
— Página 65 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
suelo para que las ruedas locas y los cd’s 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 cd’s nos servirán como ruedas de nuestro robot.
— Página 66 —
Introducción al Diseño de Microrrobots Móviles 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 cd’s 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.
— Página 67 —
Introducción al Diseño de Microrrobots Móviles 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 situación dentro del conjunto.
— Página 68 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 69 —
Introducción al Diseño de Microrrobots Móviles 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 líneas que nos
muestra los datos ofrecidos por los GP2 y el número 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);
— Página 70 —
Introducción al Diseño de Microrrobots Móviles 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);
— Página 71 —
Introducción al Diseño de Microrrobots Móviles 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;
— Página 72 —
Introducción al Diseño de Microrrobots Móviles 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;
}
— Página 73 —
Introducción al Diseño de Microrrobots Móviles 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;
— Página 74 —
Introducción al Diseño de Microrrobots Móviles 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;
— Página 75 —
Introducción al Diseño de Microrrobots Móviles 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 tensión que queremos aplicar al motor paso a paso. La conexión se
realiza mediante unas resistencias de pull-up para aplicar mayor corriente a los motores.
La conexión de toda la electrónica 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 retráctil que aplicándole calor se encoge
adoptando la forma del contenido. Para mejorar la señal de entrada de los sensores
conectamos unos condensadores entre la tensión de salida y masa, evitando así el rizado
de la señal.
— Página 76 —
Introducción al Diseño de Microrrobots Móviles 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 pensábamos
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.
Además 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..
— Página 77 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 78 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 79 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 80 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
Componentes Precio
Bandeja x2 3€
Madera de balsa 1,80€
Rueda de plástico 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 retráctil 0,95€
Bobina de grapin 10€
Estaño 1€
Cd´s/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€
— Página 81 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
15. CONCLUSIONES
Las conclusiones que podemos sacar de las competiciones de Alcalá son que la
participación siempre a sido baja, incluso descendiendo en cada año. Se ha visto que el
laberinto desconocido los participantes tenían 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
académica admirable, el participar en competiciones les da mucha experiencia en amplia
variedad de sectores, la robótica ayuda al estudiante a aumentar conocimientos para
posteriormente poder aplicarlos a sus estudios, o simplemente por joby.
En cuanto a la estructura hemos visto que es preferible usar algo más de tiempo
decidiendo una buena, ya que una mala elección podría complicar la salida del laberinto.
Por otro lado, hemos visto que dependiendo del presupuesto que tengamos
conseguiremos un resultado mejor, ya que, por ejemplo, el material de la base será mejor
o peor y tendremos más o menos precisión de los sensores.
Por último vamos a hablar de las conclusiones que hemos sacado a la hora de
diseñar el robot.
Este ha sido el primer robot que hemos intentado montar. Nos hemos encontrado
con muchos problemas que a priori no pensábamos que podrían ocurrir.
Para comenzar el diseño de nuestro robot pensamos en utilizar la herramienta Catia, ya que
parecía 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 había 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 diseño mecánico. Hay múltiples herramientas
dentro de Catia que podrían habernos ayudado, incluso más que la parte mecánica, ya que
el peso o el centro de gravedad bien definidos puede hacer un montaje mucho más sencillo.
Como conclusión, es mejor trabajarse el diseño en Catia en todas sus posibilidades y luego
ponerse con el montaje.
— Página 82 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
— Página 83 —
Introducción al Diseño de Microrrobots Móviles Trabajos en Grupo
16. Bibliografía.
Información 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
— Página 84 —
Introducción al Diseño de Microrrobots Móviles 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
Información complementaria:
http://www.depeca.uah.es
Información CATIA:
— Página 85 —