You are on page 1of 6

See

discussions, stats, and author profiles for this publication at: https://www.researchgate.net/publication/267394680

DISEO Y CONSTRUCCIN DE MICROMOUSE DE


ALTO DESEMPEO

Conference Paper October 2014

CITATIONS READS

0 2,074

3 authors, including:

Manuel Joann Nez Pedro Cardenas


National University of Colombia National University of Colombia
3 PUBLICATIONS 0 CITATIONS 33 PUBLICATIONS 146 CITATIONS

SEE PROFILE SEE PROFILE

Some of the authors of this publication are also working on these related projects:

Diseo de un Controlador Electrnico para la Reduccin de Componentes Armnicos en Redes de


Alimentacin Trifsica View project

All content following this page was uploaded by Pedro Cardenas on 08 September 2015.

The user has requested enhancement of the downloaded file.


Diseo y construccin de Micromouse de alto
desempeo
NUEZ TORRES, Manuel J. Ing. CRDENAS H., Pedro F. RAMIREZ, HEREDIA Ricardo
/Estudiante /Profesor Asociado. ./Profesor Asociado
Universidad Nacional de Colombia Universidad Nacional de Colombia Universidad Nacional de Colombia
Departamento de Ingeniera Mecnica y Departamento de Ingeniera Mecnica y Departamento de Ingeniera Mecnica y
Mecatrnica Mecatrnica Mecatrnica
Bogot-Colombia Bogot-Colombia Bogot-Colombia
mjnunezt@unal.edu.co pfcardenash@unal.edu.co. reramirezh@unal.edu.co

Abstract En este documento se muestra la metodologa de para promover la generacin de desarrollo de conocimiento en
diseo de un Micromouse como producto final con la descripcin el rea de la robtica, se recopil el conocimiento de cmo
de todas las soluciones de hardware y software para lograr un construir este tipo de vehculos. [1].
rendimiento deseado del mismo, que incluye el desglose tanto de
hardware como de software para determinar utilidades II. CARACTERISTICAS DEL MICROMOUSE
necesarias o innecesarias que fueron analizadas para escoger una
El Micromouse en una plataforma autnoma e inteligente, que
solucin de diseo. Para este diseo se tienen en cuenta las
diversas caractersticas y reglas de los concursos de micromouse se desplaza en un ambiente caracterizado por una pista
a nivel internacional y las tecnologas a las que se tiene acceso, estrecha y donde el tiempo de recorrido es calificado. Por lo
sin llegar a los detalles de las pruebas de campo ni la puesta a que las tendencias de construccin seguidas por los
punto del sistema de control. competidores de todo el mundo han sido las siguientes:

KeywordsMicromouse, microcontrolador TM4C123G6HPM, El chasis ancho y la altura baja, para garantizar un


Sensores De Proximidad Vcnl4010. centro de gravedad bajo y una mayor estabilidad en las
curvas.
I. INTRODUCCIN
El Micromouse es un pequeo robot autnomo construido Llantas en pares de cada lado, con el fin de aumentar el
para resolver un laberinto. El primer registro del problema agarre.
Ratn versus laberinto puede ser encontrado en 1950. Este Llantas con recubrimiento de goma, o totalmente
fue presentado por Cloude Shannon, quien construy la hechas de goma.
primera mquina para resolver un laberinto. La competencia de
Micromouse comenz en los 70s [7], en donde los robots Motores elctricos, son preferidos los motores con
fueron puestos a prueba en comparacin al desempeo de otros escobillas que los sin escobillas (brushless) o los paso a
robots. El ratn es construido para resolver autnomamente un paso (steppers). Sin embargo en los ltimos aos han
laberinto con el objetivo de llegar al centro de ste, partiendo cobrado popularidad los motores sin armadura
desde una de las esquinas del laberinto. A travs de sus (coreless).
algoritmos de programacin y configuracin, el Micromouse
debe ser capaz de almacenar en memoria el laberinto, su Encoders pticos para cada eje, con resolucin no
posicin dentro de este, grabar su recorrido por el mismo y menor a 1 grado por pulso, lo ms pequeos posibles, y
optimizar la ruta en el tiempo para resolverlo. conectados por transmisin ya sea al eje de motor o al
de las llantas.
El Micromouse es un robot mvil que integra las
necesidades y caractersticas mecnicas de una plataforma Sensores de proximidad, donde los ms populares
mvil (velocidad, giro sincronizado, entre otras), la capacidad siempre han sido los pticos, de preferencia infrarrojos,
sensorial para el reconocimiento del entorno y la habilidad de instalando por separado el emisor y el receptor, o
interactuar con ste por medio de informacin digitalizada y sensores pticos integrados.
codificada. El robot usa esa caractersticas para cumplir con el En general, se usan 4 o ms sensores pticos en una
objetivo de solucionar un laberinto. plataforma.
El Micromouse es un desarrollo tpico del rea de robtica Bateras de litio de dos o ms celdas de alto desempeo,
con requerimientos dinmicos (velocidad, giros, entre otros), y buscando la mejor relacin entre la potencia, el peso,
su diseo que incluye tcnicas de construccin para el y el tamao.
hardware y software e implementar mtodos para interpretar e
interactuar con su entorno. Pensando en la posibilidad de La gama de microcontroladores ms usada para el
facilitar la construccin de plataformas como el Micromouse control es la de 32 bits, de las series Cortex-Mx, donde
los favoritos son los Cortex-M4 ya que soportan punto
flotante
Es comn usar como chasis la misma placa de circuito
impreso, reduciendo as el peso y la complejidad de la
plataforma. Fig. 1. Motores coreless MK06-4.5 [2]

Sensores como acelermetros, giroscopios y/o brjulas B. Llantas


magnticas, para garantizar giros exactos a 45, 90 y 180 Debido a la lgica de funcionamiento del Micromouse en la
grados. fase de carrera, en donde el desplazamiento sin deslizamiento
III. MTODO DE CONSTRUCCIN es crucial, se eligi la goma como material de las llantas, dado
su alto coeficiente de friccin.
Al iniciar la implementacin del Micromouse, adems de la
programacin de los componentes electrnicos, de la seleccin
de los componentes mecnicos, se debe tener en cuenta en
primer lugar la relacin de tamao respecto al espacio
permitido por el laberinto.
La principal limitacin son las dimensiones del robot que
estan establecidas por el laberinto [5], el objetivo es mantener
el tamao de los elementos al mnimo, ensamblndolos de la
forma ms compacta, reduciendo el espacio no utilizado. Al
mismo tiempo, liberar espacio para acomodar otros
componentes, por lo que el diseo asistido por computadora es
de gran utilidad para observar todas las posibles
Fig. 2. Diseo y dimensin de las llantas.
configuraciones y las fallas que puedan surgir durante la
implementacin y sean corregidas en las etapas de diseo C. Engranajes
conceptual y de detalle.. Los engranajes se eligieron convenientemente para crear
Es importante tener muy en cuenta el diseo del circuito una transmisin directa entre el motor y llanta, en donde el
impreso (PCB) para obtener los valores mximos y mnimos segundo tiene una forma tal que puede soportar carga radial y
dimensionales, ya que ste es el chasis del Micromouse, servir de eje de la llanta. Ambos engranajes (Figuras 3 y 4) se
logrando definir espacios disponibles para posicionar los eligieron del mismo mdulo, para asegurar su funcionamiento
elementos mecnicos, y tambin imponiendo las limitaciones en conjunto, y con las dimensiones ms aproximadas a las
en el diseo final. normalizadas, pues por el reducido tamao no es fcil un
proceso de fabricacin exacto.
Finalmente es crtico crear el modelo CAD 3D del diseo
del PCB, para acoplar todos los elementos y garantizar que
encajan correctamente y no hayan elementos que se solapen o
interfieran en su funcionamiento. Cuando se disea y se
construye un nuevo robot para ser implementado, se hace
necesario utilizar un framework que permita explotar de forma
controlada las funcionalidades para las que la planta fsica fue
creada. Existen mltiples ejemplos de plataformas robticas
con hardware y software desarrollado por equipos de trabajo. Fig. 3. Engrane del motor. [2]

IV. SELECCIN DE COMPONENTES


En general se requiere un conjunto de elementos mnimo
necesario para construir un Micromouse genrico. Pensando en
esto, se presenta una lista de elementos que se deben ir
seleccionando de acuerdo a las necesidades de la plataforma.
A. Motores
Se escogieron motores coreless, que por su alto desempeo
y poco tamao suelen usarse en aeromodelismo. Estos motores
son los MK06-4.5 (Fig. 1) de alta velocidad, bajo torque, con Fig. 4. Engrane de la llanta. [2]
una tensin de trabajo de 3.5v, que se ajusta a las tensiones
tpicas de la electrnica de control. D. Bateria
Dado que toda la electrnica se dise para funcionar a
3,3v por facilidad y compatibilidad, la eleccin inmediata
fueron las bateras de Polmero de Litio o LiPo (Fig. 5), ya que
tienen una alta relacin capacidad de carga a peso. Pueden
alimentar la electrnica y los motores sin problemas, ya que clculos al microprocesador, y lo segundo a que este protocolo
una nica celda puede suministrar 3,7v a 1000mAh. es el ms recomendado para el uso de sensores.
J. Encoders
Los encoders permiten controlar el movimiento de los
motores y el avance de la plataforma. Hay diferentes tipos de
encoders, teniendo en cuenta la limitacin de tamao y la
exigencia de resolucin (al menos un pulso por grado), la lista
de opciones se redujo a un solo tipo de encoder: el encoder de
cuadratura y dos fabricantes. El seleccionado fue el encoder 7S
fabricado por NEMICON, quien lo cataloga en la gama de
Ultra Miniature Size Encoder o encoders ultra pequeos.
Fig. 5. Batera LiPo. [2]
Este encoder tiene una resolucin de 400 pulsos por vuelta, o
0,9 grados por pulso, y un dimetro de 7 milmetros.
E. Reguladores
Para convertir la fuente de alimentacin en una tensin
constante de 3,3v con la menos cantidad de ruidos, picos, y
cadas, se opt por una fuente switcheada. La opcin
seleccionada fue el TPS62163 que puede mantener la tensin
deseada, aun si la fuente es variable, siempre que sta supere la
tensin que se est regulando, y adems es capaz de generar
una seal de alerta si esto no se cumple [3].
F. Driver de Motor
Para posibilitar al microcontrolador dar rdenes a los
motores, es necesario un driver que proporcione la potencia de Fig. 6. Encoder 7S.
las seales. El driver que se us fue el DRV8836 que tiene
salida dual, lo que indica que un solo driver puede controlar los V. DISEO CONCEPTUAL
dos motores al tiempo, adems tiene lmites de seguridad a 1 A medida que han ido avanzando las versiones del concurso
amperio, que no debern ser superados a menos que haya un Micromouse, y se ido perfeccionando las plataformas, tambin
dao o problema de funcionamiento [4]. se ha ido centralizando el diseo conceptual de las mismas.
G. Microcontrolador Basados en los anteriores participantes, en el conocimiento
propio, y en la expectativa de funcionamiento, el diseo
Se eligi el microcontrolador TM4C123G6PM, que es un
conceptual utilizado para el desarrollo de esta plataforma se
Cortex-M4 de 32Bits, el ms alto de su gama. Se eligi ya que
describe a continuacin.
para la solucin del laberinto, y el control de alta velocidad,
requieren de clculos complejos. Esta gama de VI. DISEO ELECTRNICO
microcontroladores tienen la capacidad de hacer
multiplicaciones en un ciclo de reloj, soporta el uso de nmeros En primera medida est el diseo esquemtico, en el cual se
decimales o de punto flotante, y poseen mdulos de hardware consideran todos los elementos electrnicos necesarios, as
especializados y muy tiles para esta aplicacin, como el QEI o como los puntos de conexin para todos los dems elementos
mdulo de encoder de cuadratura. que intervienen y que no hacen parte de la tarjeta de control. La
parte mecnica se cie a los espacios que se hayan dispuesto en
H. Sensores de proximidad la etapa anterior.
Hay varias tcnicas de medir proximidad, cada una con
rangos de medida diferente. Dadas las caractersticas
dimensionales de los micromouses y los laberintos, la ms
apropiada es la de reflexin de luz infrarroja. Por esta razn se
eligieron los sensores VCNL4010, que de manera embebida
realiza la medicin de distancia por medicin de reflexin
pulsos de luz, compensa el error debido a la luz ambiente, filtra
los resultados para reducir el ruido, y los trasmite por
comunicacin IIC. Adems su pequeo tamao es muy
conveniente, y facilita su ubicacin en la plataforma.
I. Giroscopio
Este sensor muy importante en carrera, ya que permite que
la plataforma avance en lnea recta y gire en ngulos
especficos. En cuanto a tecnologas, se eligi un sensor con
procesamiento de seal embebido y que fuera compatible con Fig. 7. Diagrama de Flujo.
el protocolo IIC. Lo primero debido a que le reduce la carga de
Fig. 11. Sistema de traccin ensamblado.

Una distribucin recurrente entre los modelos vistos, es la


Fig. 8. Diseo esquemtico. de acoplar directamente las llantas al eje de los encoders,
mientras el motor trasmite potencia mediante engranajes a un
Posteriormente se desarrolla el PCB, en el que es de suma
lado de la llanta. El concepto es muy sencillo, pero lograr
importancia la distribucin de elementos, y la previsin de los
ajustar los espacios, los engranajes, las relaciones entre dientes
espacios que se usarn para los elementos mecnicos, puertos
y que se ajuste a los elementos disponibles en el mercado es
de conexin, alimentacin, y cualquier otro elemento que se
realmente complicado y requiere de probar de manera iterada
vaya a usar
diferentes opciones hasta encontrar el ajuste ms adecuado.
VII. DISEO MECNICO La configuracin que finalmente se acept e implemento en
Dentro de la bsqueda por optimizar el espacio se este desarrollo, se puede observar en la Figura 11.
consideraron ms de un diseo y diferentes distribuciones de
los componentes mecnicos. Por lo que se desarroll en varias VIII. SOFTWARE Y ALGORITMOS
etapas que luego se ensamblaron para al modelo final de la El software del micromouse se puede dividir en 2 niveles:
plataforma. el control de movimiento y el algoritmo de resolucin del
laberinto. El primer nivel se encarga del control de posicin
A. Sistema de Traccin mientras el segundo se preocupa por decidir a qu celda debe ir
En el desarrollo del sistema de traccin, en el que est el micromouse. Estos niveles interactan entre s envindose
involucrado el encoder que retroalimenta el mecanismo se opt informacin sobre el laberinto y sobre la posicin que se quiere
por solucionar primero el acople entre la llanta y el encoder, alcanzar.
mediante uno de los engranajes seleccionados, de manera que
la medicin de posicin de la llanta sea directa. La solucin fue A. Movimiento
usar el eje del encoder como soporte del engrane, y a su vez El control de movimiento es el encargado de mover el
como soporte de la llanta. micromouse de una posicin a otra avanzando en lnea recta o
girando sobre su propio eje mientras garantiza una orientacin
y una distancia respecto a las paredes del laberinto. Este
controlador se mantiene activo todo el tiempo y es
retroalimentado por los sensores infrarrojo, el giroscopio y los
encoders de los motores. Con la informacin obtenida de los
sensores en cada instante se calculan los anchos de pulso
correspondientes a las seales de control de los motores y se
configuran dichos anchos de pulso en el mdulo PWM del
microcontrolador.
B. Deteccin de obstculos
Conforme el micromouse avanza, el control de movimiento
Fig. 10. Ensamble Llanta-Engrane-Encoder. sabe cuanta distancia y ngulo le falta para llegar a la posicin
que se le indic y aprovecha esta informacin para saber si est
Posteriormente se acopl el motor, por medio de una pieza en una celda del laberinto o en otra, luego combina esta
plstica que lo sujeta a la distancia exacta dada por la distancia informacin con la de los sensores infrarrojos para notificar al
entre centros de engranajes, y que al mismo tiempo acopla todo algoritmo de resolucin del laberinto sobre el cambio de celda,
el sistema a la tarjeta de control. nmero y posicin de los muros que rodean la celda en la que
se encuentra.
C. Control de Giro y avance
El control de giro consiste en el control de la cantidad
angular que es deseada para el siguiente avance del
micromouse, debido a que el giro se realiza luego de terminar
un avance y antes de proceder al siguiente. El control de giro Fig. 12. Modelo CAD micromouse final
toma la medida del giroscopio que al inicio del recorrido es 0
de giro y el movimiento coordinado de los motores para ubicar
angularmente el micromouse en el espacio 2D.
D. Algoritmo de resolucin
Este nivel del controlador posee una mquina de estados
finitos con la que sabe si est en la etapa de exploracin del
laberinto, o si est en la etapa de carrera. Adems divide la
etapa de exploracin en dos partes, llegar a la salida y regresar
al inicio del laberinto, esto es necesario para el funcionamiento
del algoritmo de bsqueda del camino y para que al regresar al
comienzo intente pasar por celdas que no hayan sido
exploradas, con el fin de encontrar otros caminos que podran
ser ms cortos que el que se encontr inicialmente.
Fig. 13. Modelo CAD Micromouse Final vista superior e inferior.
Se utiliz el algoritmo Floodfill (inundacin) para la
AGRADECIMIENTOS
exploracin, el cual calcula las distancias de cada celda a la
fuente de la inundacin. La idea es inundar desde la salida del Agradecimiento a la Universidad Nacional de Colombia
laberinto o desde la celda donde se encuentra el micromouse de atravs de la Direccin de Investigacin de sede (DIB) y
tal manera que al completar la inundacin se puede hallar un Vicedecantura de investigacin de la Facultad de Ingeniera Al
camino simplemente con pasar a la celda vecina que tenga una
Programa de fortalecimiento. Programa nacional de semilleros
distancia menor, y que no est aislada de sta por un muro.
de investigacin, creacin e innovacin de la Universidad
Tras realizar la inundacin se presentarn varios caminos. Nacional de Colombia 2013-2015. Proyecto 18344 Robot A
Durante la etapa exploracin no hay suficiente informacin Escala Tipo Industrial. Y al proyecto Cdigo:
para escoger un camino as que se escoge arbitrariamente. Al 18570 Adquisicin, Ensamble y Puesta en Marcha de
hacer esto tambin se reduce el tiempo de ejecucin. Una vez Impresora 3d de Bajo Costo Para la Asignatura de Diseo
se termina la etapa de exploracin y se ha regresado al Mecatrnico.
comienzo del laberinto se puede buscar el mejor camino con la
informacin conocida dejando quieto el micromouse por un A COLCIENCIAS que a trevs del programa de Formacin de
tiempo, dndole as la oportunidad al algoritmo de seleccin de Doctores propociono la beca de Doctorado del Ingeniero
ejecutarse sin que afecte el control del micromouse. Luego, Pedro Faban Crdenas Herrera.
durante la etapa de carrera, se mantiene el camino escogido
quitndole carga al microcontrolador y permitindole dedicarse REFERENCIAS
al control de movimiento.
[1] Obdrzalek David, Gottscheber Achim, Research and Education in
El diseo final se muestra en las siguientes figuras donde Robotics - EUROBOT 2010: International Conference, Rapperswil-
ya se encuentran acopladas cada una de las fases que Jona, Switzerland, May 27-30, 2010. Springer. p 200, 2011.
comprendieron el diseo. [2] Homefly, Section: Coreless Motors, disponible en:
https://www.homefly.com/products.asp?id=44. Consultado en: 6 de
Abril 2013.
[3] Texas Instruments Inc. 3V-17V 1A Step-Down Converters with DCS-
Control (Rev. C). SLVSAM2C, November 2011, Revised September
2013.
[4] Texas Instruments Inc. Dual Low-Voltage H-Bridge IC, DRV8836
(Rev. B). SLVSB17A, March 2012, Revised September 2013.
[5] Web Site. Micromose Rules Region 6. Disponible en:
http://ieee.ucsd.edu/projects/micromouse/rules.php . Consultado en: 20
de junio 2014
[6] [5]MIT, Motion Capture, http://web.mit.edu/comm-
forum/papers/furniss.html , Consultado en: 6 de Abril 2013.
[1] Web Site. Micromouse on line. Disponible en:
http://www.micromouseonline.com/micromouse-book/history/,
Consultado en: 20 de Junio 2014.

View publication stats

You might also like