Dispositivo Infrarrojo Detector de Obstáculos para Robots jugadores de futbol.

Marco Antonio Ventura Murillo, Dr. Alejandro Aceves López
Abstract— Los Robots Jugadores de futbol son un gran avance tecnológico, pueden localizar la pelota, trasladarse hasta ella y posicionarse en dirección que al patear la pelota esta valla en dirección de la portería contraria, sin embargo, en ocasiones patean hacia la portería sin darse cuenta que enfrente de ellos hay un contrincante; un detector de objetos es un aditamento que solucionaría ese problema proporcionando al robot la capacidad de detectar la distancia de objetos enfrente de él. En el presente trabajo se presentan las características de este dispositivo. (DIDO) el cual es conectado como cualquier servomotor o sensor Dynamixel y proporcionarle al robot la capacidad de identificar la distancia de algún objeto enfrente de él.

II. ELECTRÓNICA DEL DISPOSITIVO INFRARROJO DETECTOR DE OBSTÁCULOS.
DIDO posee con un PIC16F88 el cual cuenta con las características buscadas para este dispositivo: 18 pines de los cuales 16 son de entrada/salida, con 4KB para la escritura del programa, oscilador externo de hasta 20 MHz, 7 canales de 10 bits de analógico a digital (ADC), 256 bytes de memoria EEPROM, Addressable Universal Synchronous Asynchronous Receiver Transmitter (AUSART) [1] entre otras cosas. También posee sensores de la marca SHARP GP2Y0A21YK. Sensor con alcance de 10 a 80 cm. Salida analógica de 0.4v a los 80cm y 2.3v a los 10cm [2]. Estos dos componentes son los primordiales en el circuito. De igual forma posee los integrados 74HC126 y 74HC04 que transforman de la comunicación Transmisor-Receptor Asíncrono Universal (UART) a half duplex, un regulador, cristal de cuarzo de 8Mhz, capacitores cerámicos y electrolíticos, un LED, resistencias y un conector. Cada uno de los elementos fue investigado para corroborar el correcto funcionamiento de DIDO, y así evitar un mal funcionamiento. Fueron realizadas pruebas antes de realizar el PCB del circuito para comprobar el comportamiento de los componentes.

I. INTRODUCCIÓN
la enorme cantidad de Robots que Dexisten de hoy en día, se encuentran los Robots
ENTRO

Humanoides, los cuales dentro de las actividades que estos pueden realizar se encuentra el futbol. Estos Robots pueden identificar una pelota mediante una cámara ubicada en su cabeza y dirigirse hacia ella para posicionarse de tal manera que al patear la pelota está entre en la portería del equipo contrario. Estos Robots cada día van mejorando en cuanto a los movimientos y la capacidad de jugar, pero uno de los problemas que presentan es que al momento de patear la pelota el Robot no sabe si hay algún objeto entre él y la portería, en consecuencia la pelota podría chocar con el Robot contrincante y no ir en dirección de la portería. Esta capacidad de decisión de patear o no patear solo puede lograrse si el Robot reconociera que existe algo enfrente de él que le obstruye el paso a la pelota si la patea. Es por ello que en el presente documento se presenta un Dispositivo Infrarrojo Detector de Obstáculos

.Diagrama del Dispositivo Infrarrojo Detector de Obstáculos (DIDO) Fig. 1.Simulación del diagrama del Dispositivo Infrarrojo Detector de Obstáculos (DIDO) . 2.El Diagrama del circuito es el siguiente: Fig..

5cm  Ancho: 4cm  Altura: 6cm El dispositivo se diseño para ser puesto como un cinturón en el Robot.-Relación entre el voltaje de salida (Vo) y la distancia del objeto reflejante de los sensores.4. [SHARP Corporation. a. la cual se adapto para posicionar dos de los sensores de tal manera que al momento de colocarlo al Robot estos queden a 45° del frente del Robot. .com/robotics/info/articles/irlinear/irlinear.-Linealización de sensores Sharp. b.sharpsma. Debido a este problema se investigo y se encontró una fórmula para poder determinar la distancia con este tipo de sensores. [http://www. Fórmula 1.Ubicación de los sensores.III. Los sensores utilizados tienen la desventaja de no ser lineales.acroname. IV. MAQUINADO DEL DISPOSITIVO INFRARROJO DETECTOR DE OBSTÁCULOS. La placa de la electrónica de DIDO fue montada en una base realizada con acrílico de 3mm. http://www. c = Constantes de cada sensor..com/webfm_send/1208]  Largo: 6. El Dispositivo tiene las siguientes dimensiones: Fig. FORMULAS PARA LA MEDICIÓN DE LA DISTANCIA.html] Donde: y = Distancia del objeto al sensor.3. x = Numero del Convertidor Analógico Digital. esto quiere decir que un cambio en la distancia del objeto a medir no es proporcional al voltaje entregado por el sensor [3]. Datasheet GP2Y0A21YK. Fig.

Representación del envió del paquete de datos del controlador a los servomotores y viceversa.. a 5.cem. Como cada sensor está conectado a un pin del Microcontrolador diferente. el Convertidor 0x10 0x08 Error de Instrucción Error de Suma Error de Rango Colocar 1 si es recibida una instrucción no definida en el paquete de instrucciones. 0x00 0x01 0x02 0x03 Modo. Fórmula 2.-Formula para el sensor 1. este lee el voltaje proporcionado por cada sensor y lo convierte en un número digital. 20 y 50 cm para poder sustituir en la ecuación anterior y así obtener un sistema de 3 ecuaciones para cada sensor que al resolver dan una ecuación que proporcionan la distancia de un objeto enfrente del sensor. La transmisión DIDO es similar a la de los dispositivos Dynamixel. Fórmula 3.-Formula para el sensor 2.pdf] . Colocar 1 si el checksum del paquete de instrucciones es incorrecto. x= Valor proporcionado por Analógico Digital del PIC16F88. T2400 T1200 T9600 T300 Tasa de Baudios. Escribe un valor en la tabla de control. Las instrucciones pueden ser las siguientes: Valor Nombre 0x01 0x02 PING READ DATA WRITE DATA Función No hace ninguna acción solo es para pedir al dispositivo un paquete de estatus.mx/aaceves/Bogobots/seminario/Bioloid. Colocar 1 si los parámetros enviados están fuera del rango definido. TRANSMISIÓN DE DATOS. V.Se tomaron 3 valores de cada sensor.5. Sensor 3. a enviar (Hex) 0x40 Nombre Detalle Fórmula 4. y = Distancia del objeto al sensor. Y se recibe un paquete de estado.itesm. 0x03 Sensor 2. Sensor 1. La tabla de las direcciones que irán en el Parametro1 son las siguientes: Área Dirección (Hex) 0 (0x00) 1 (0x01) 2 (0x02) Nombre Firmware ID Velocidad de transmisión Sensor 1 Sensor 2 Sensor 3 Acceso Lectura Lectura/Escritur a Lectura/Escritur a Lectura Lectura Lectura Valor inicial (Hex) 1 (0x01) 100 (0x64) 2 (0x02) EEPROM RAM 3 (0x03) 4 (0x04) 5 (0x05) ? ? ? Las velocidades de transmisión son las siguientes: Valor a enviar en el parámetro 2.-Formula para el sensor 3. 2400 1200 9600 300 Fig. Lee un valor de la tabla de control. Se envía un paquete de instrucciones. [http://homepage. Los errores pueden ser los siguientes: Num.

DIAGRAMA DE FLUJO DE DIDO.VI. .

9 [4] se configura de la siguiente manera: Fig. Fig.9. PRUEBAS DE DIDO. El programa puede ser descargado de la siguiente dirección: http://www. Para probar el dispositivo se utilizó la USB Dynamixel y el programa Termite 2. prueba con DIDO. En la última prueba.9 para comunicarse con DIDO.9.compuphase. el SMPS2Dynamixel y la fuente de alimentación que proporcionan la alimentación necesaria es de la siguiente manera: Se visualiza el paquete de instrucciones en azul y el paquete de estado en verde: Fig-8. SMPS2Dynamixel y la fuente de alimentación.htm Leer Velocidad de Transmisión (READ DATA)  Paquete de instrucciones  0xffff640402020192  Paquete de estado  0xffff6403000296 .-Conexión de DIDO con la USB2Dynamixel.com/software_termite.9. .-Configuración de Termite 2.Interfaz de termite 2. se procedió a leer los valores de la distancia de 3 objetos situados en cada uno de los 3 sensores a distancias diferentes.7..6.-Conexión de DIDO.VII. Se realizan las conexiones necesarias: El programa Termite 2. Pedir un paquete de instrucción (PING)   Paquete de instrucciones  0xffff64020198 Paquete de estado  0xffff64020099 Leer ID (READ DATA)  Paquete de instrucciones  0xffff640402010193  Paquete de estado  0xffff6403006434 Fig. La conexión de DIDO con la USB2Dynamixel.

Se procedió a colocar los bloques uno enfrente de cada sensor a las siguientes distancias: Sensor 1.-Posición del bloque enfrente del sensor 3.-Posición del bloque enfrente del sensor 2..13. Sensor 3. .-Posición de DIDO para realizar las mediciones..Bloque a 15cm Fig.Bloque a 5cm Fig.11.10.12.Como puede observarse DIDO se situó sobre unos bloques cafés.Bloque a 35cm Fig.. Fig.-Posición del bloque enfrente del sensor 1. Sensor 2.

-Visualización de los paquetes de instrucción y los paquetes de estado. aun así es un valor muy cercano al valor real del objeto.Finalmente los bloques quedaron posicionados a las distancias que se mencionaron. con esta información el Robot podrá decidir si patear o no hacia esa dirección. PI  ff ff 64 02 01 98 PE  ff ff 64 02 00 99 .15. Las ventajas que trae consigo este dispositivo es que proporciona al robot la capacidad de detectar un objeto enfrente de él y decirle a qué distancia esta. CONCLUSIÓN. al pasarlos a decimal obtuvimos los valores de las distancias en centímetros.-Posición de los 3 bloques.  Sensor1 = 0x23 = 35  Sensor2 = 0x05 = 5  Sensor3 = 0x0d = 13 Fig. VIII. Como se puede observar al realizar las pruebas DIDO responde como cualquier dispositivo Dynamixel. Se mandan los paquetes de datos atreves del programa Termite 2. Fig. Seguidamente se enviaron los paquetes instrucción para leer cada uno de los sensores.14. el sensor 3 da un valor de -2cms el valor real. PI  ff ff 64 04 02 03 01 91 PE  ff ff 64 03 00 23 75 PI  ff ff 64 04 02 04 01 90 PE  ff ff 64 03 00 05 93 PI  ff ff 64 04 02 05 01 8f PE  ff ff 64 03 00 0d 8b Leer sensor 1 Sensor1 = 0x23 Leer sensor 1 Sensor1 = 0x05 Leer sensor 1 Sensor1 = 0x0d de Los números proporcionados por los paquetes de datos están en Hexadecimal. Como podemos observar primero se envió un paquete con la instrucción PING el cual respondió sin ningún error. esto se debe a que los sensores tienen una tolerancia dependiendo de la distancia que midan. DIDO puede ser conectado a los Robots jugadores de futbol que utilicen los servomotores Dynamixel y ser conectado junto con ellos.9: Si se compara con las distancias reales de los objetos observaremos que el sensor 1 y 2 dan un valor exacto.

(2 de Agosto de 2012).microchip.htm . Recuperado el 23 de Julio de 2012. (2005).sharpsma.html [4] CompuPhase.com/webfm_send/1208 [3]Acroname Inc.acroname. de http://www. REFERENCIAS. de Linearizing Sharp Ranger Data: http://www.compuphase. Recuperado el 6 de Julio de 2012. Termite: a simple RS232 terminal.com/software_termite. [1] Microchip Technology Inc. Acroname Robotics.pdf [2] SHARP Corporation. Datasheet. Recuperado el 8 de Agosto de 2012. (2005). Recuperado el 10 de Julio de 2012. Datasheet.com/downloads/en/devicedoc/ 30487c.IX. de PIC16F87/88: http://ww1.com/robotics/info/articles/irlin ear/irlinear. de GP2Y0A21YK Optoelectronic Device: http://www.

Sign up to vote on this title
UsefulNot useful