Todas las personas tenemos alguna habilidad, y si bien en Cómo Lo Hago ya tenemos un experto en electrónica, desde hoy me gustaría compartir con ustedes una de mis especialidades (o al menos a eso me he dedicado a estudiar), proyectos de Robótica.
Hace algunos años participé en un entretenido concurso de Mecatrónica en la Universidad del Valle de México (en Ciudad de México), y hoy publicaré en este artículo uno de los robots que presenté, un clásico “seguidor de líneas” (o denominado en competencias internacionales como line follower), más adelante seguiremos con una sonda de exploración integrado con paneles solares, pero… vamos de a poco.
Luego del salto podrán continuar leyendo este tutorial.
Un clásico ejercicio para cualquier estudiante de Ingeniería en Robótica, Mecatrónica o Electrónica (en algunos casos), es construir un robot que siga una línea, básicamente porque esto integra muchas áreas de las ciencias, permitiendo desarrollar un conocimiento empírico sobre el control automático.
En la actualidad se realizan concursos en todo el mundo, generalmente patrocinados por el IEEE, que miden desde el tiempo que demora el robot en recorrer la pista, hasta en la calidad de detectar anomalías en la ruta.
Una de las técnicas mas usadas para cumplir este propósito es el Puente H, que permite ante un impulso, girar un motor eléctrico DC y de esta forma tener un rápido tiempo de reacción (casi instantáneo) para seguir una ruta, no obstante, hoy les enseñaremos cómo seguir una línea con un poco mas de inteligencia artificial usando un microcontrolador (Basic Stamp) y fotorresistencias.
El primer paso es construir nuestra pista, es importante probar con más de un diseño, debido a que en las competencias las pistas suelen varias en cada etapa, y nuestro robot debe ser capaz de enfrentar situaciones complejas (curvas cerradas), así cómo también tener una tolerancia correcta de la luz (lo veremos mas adelante en el algoritmo).
Luego que hemos construido nuestras pistas comenzamos a implementar nuestro circuito directamente en nuestro Basic Stamp, una de las razones por las cuales hemos escogido este dispositivo para el tutorial es debido a que integra una placa de pruebas (o protoboard), conectado directamente a nuestro controlador BS2, en otras palabras está todo integrado, de esta forma sólo necesitamos conectar nuestro circuito.
Procesador: 20 mhz, procesa 4.000 instruciones por segundo, contiene una memoria EEPROM de 2 KBytes, usa de 5 a 12 V(dc) y su interfaz nativa es serial.
A continuación les presentamos un diagrama del circuito:
Las fotorresistencias son utilizadas para detectar variaciones en el nivel de intensidad de la luz, en este caso cómo se genera un contraste entre el blanco de la línea y el negro del fondo, nuestro robot las utiliza para denotar cuando se presenta una curva.
Un fotorresistor es un resistencia cuyo valor depende de la intensidad de luz (también se conocen como LDR: light dependent resistor), y cubren un espectro similar al ojo humano. Los elementos activos de estos fotorresistores están hechos de sulfuro de cadmio (CdS). La luz entra en la capa smiconductora que está aplicada sobre un sustrato cerámico.
En nuestro ejercicio utilizaremos este dispositivo para medir la luminancia (que se mide en lux), el objetivo es que nuestro robot gire hacia la luz (en este caso la línea blanca).
Cómo pueden ver en la imagen las fotorresistores mantendrán una distancia asociada al ancho de nuestra pista para ir identificando las variaciones de lux, adicionalmente en la imagen podrán apreciar que nuestro robot que estaba en los “huesos” se ha transformado en una silla… Personalmente creo que cada proyecto que uno construye debe ir un poco más allá, y transformarse eventualmente en un aporte para la sociedad, esta silla de ruedas fue pensada para gente minusválida para que pudieran trasportarte de forma más fácil por algunos establecimientos (ejemplo: clínicas, hospitales, universidades, etc.).
A continuación les dejó el mismo diagrama del circuito presentado anteriormente, pero con un dibujo mucho mas amigable para realizar las conexiones en la protoboard del Basic Stamp.
Una vez que tengamos nuestro circuito conectado, podemos montar la Basic Stamp en una arquitectura mecánica con ruedas, donde instalaremos los servomotores. Nuestro modelo consta de 2 servomotores y cumplen la función tracción y dirección. Están montados en un chasis de madera que es la base de la silla de rueda.
Estos motores tienen retroalimentación de posición interna con rangos de giros típicos de 90º y 180º, gneran una gran fuerza y torque con un bajo consumo de energía haciéndolos ideales para nuestro objetivo. Cabe destacar que el sistema entero es alimentado por 4 baterías AA de 1,5 voltios generando una diferencia potencial de 6 voltios ubicados en el mismo chasis.
Cómo pueden apreciar en la parte superior de los servomotores se indican los 3 cables que debemos conectar a nuestro Basic Stamp (tierra, voltaje directo y finalmente el cable que recibe los pulsos desde el microcontrolador).
El siguiente paso es programar nuestro robot, y para ello ocuparemos la conexión serial, tal cómo lo indicamos en la descripción de materiales si tu computador no tiene una conexión de este tipo, puedes usar un conversar serial-usb.
A continuación presentamos el algoritmo programado en el lenguaje nativo de los Basic Stamp, PBasic. Cómo podrán apreciar el código está comentado con una comilla simple ‘ para explicar que acción ejecuta cada línea.
‘ {$STAMP BS2}
‘ {$PBASIC 2.5}‘————-[ Line non-twitter Follower de CLH ]—————
‘ Archivo……………CLH Follower.bs2
‘ Propósito………….Tutorial CLH
‘ Autor……………..Goten
‘ E-mail…………….guillermodiazs@gmail.com
‘ Fecha de Desarrollo….03/12/09‘——- [Descripción del Programa ] ————-
‘ El programa consiste basicamente en recorrer la pista, siguiendo la línea blanca con gran fidelidad mediante el uso de fotoresistencias ubicadas en el robot como “bigotes” a una distancia de 5cm. el uno del otro, que determinen la luminosidad que se encuentra bajo ellos y con lo cual se puede determinar el momento exacto en que comience una curva, debido a que el rango de luminosidad que reciben las fotoresistencias cambiará, y el robot doblará en esa dirección.
‘———-[ Declaración de variables ]———–
fizquierdo VAR Word ‘ Almacenan los tiempos RC del fotoresistores izquierdo y derecho
fderecho VAR Word
x VAR Word‘—————[ Inicialización ]————–
DEBUG CLS ‘ Abre y limpia la pantalla de datos
OUTPUT 2 ‘ Fija P2 como salida
FREQOUT 2,2000,3000 ‘ Indicador de resetinicio:
PULSOUT 12, 600 ‘ Aplica un pulso para avanzar (los servos están conectados en estos puntos).
PULSOUT 13, 900 ‘HIGH 5 ‘ Fija P5 como salida alta (fotorresistor)
PAUSE 3 ‘ Pause de 3ms
RCTIME 5, 1, fizquierdo ‘ Mide el tiempo de RC en eP5HIGH 3 ‘ Fija P3 como salida alta (fotorresistor)
PAUSE 3 ‘ Pause de 3ms
RCTIME 3, 1, fderecho ‘ Mide el tiempo de RC en eP3IF fizquierdo > 40 AND fderecho > 50 THEN inicio ‘ Condiciones que dependiendo de
IF fizquierdo < 40 AND fderecho > 50 THEN irizquierda ‘ los tiempos de RC recibidos
IF fizquierdo > 40 AND fderecho < 50 THEN irderecha ‘ determinan que subrutina seguir.* Este es el momento donde dirime que hacer.
GOTO inicio ‘ regresa a inicio
irderecha: ‘ aplica un pulso a la derecha por un tiempo determinadoFOR x=1 TO 20 ‘ por la variable x
PULSOUT 12,790
PULSOUT 13, 1000
NEXT
GOTO inicio ‘ regresa a inicioirizquierda: ‘ aplica un pulso a la izquierda por un tiempo determinado
FOR x=1 TO 20 ‘ por la variable x
PULSOUT 12,500
PULSOUT 13, 750
NEXT
GOTO inicio ‘ regresa a inicio‘————– Fin del programa —————
Cargan esta información en la EEPROM del Basic Stamp utilizando el mismo software descargado en la lista de materiales y listo, han construido su primer line follower.
Les llamará la atención que en los materiales indicamos 2 tipos de capacitores, y luego en el diagrama sólo mostramos 1 tipo, esto es debido a que un fotorresitor es un dispositivo analógico y su valor cambia en forma continua de acuerdo a la luminancia, que es otro valor analógico. La resistencia del fotorresitor es muy baja cuando se expone directamente a la luz del sol. A medida que desciende el nivel de luz, su resistencia aumenta. En completa oscuridad, la resistencia del fotorresitor puede alcanzar valores muy altos. Aunque el fotorresitor es analógico, esto no quiere decir que sea lineal. Esto significa que si la fuente de luz (luminancia) varía a una proporción constante, el valor del fotorresitor no necesariamente variará a una proporción constante. El objetivo de contar con capacitores de distinta capacidad es que ustedes puedan cambiarlos según las condiciones de luz y tener un resultad mucho más efectivo.
A continuación les dejo un video de ejemplo (les pido disculpas de antemano por la calidad, pero no contaba con una buena cámara).
Les agradezco la paciencia de haber leído este tutorial y espero sinceramente que les haya gustado, si tienen dudas o consultas, no duden en escribirnos en la sección de comentarios más adelante, para finalizar agradezco y cito las licencias de las siguientes imágenes:
Cordialmente,
8:10:47 am
Donde encuentro esos materiales????
estoy muy interesado en hacerlo
Gracias
3:27:51 am
tendras algo asi como para el control de apertura y cerrado sensillo de una puerta por medio de infrarojo
es que ya hicimos un sensor que nos manda la señal a un relevador y provoca el giro del motor pero me gustaria saber como lograr que al dar otro pulso girar en el sentido opuesto y asi lograr la apertura ?
seria con un puente h ?o tendria que implementar ademas el uso de un micro controlador ?
gracias !!!
4:31:47 pm
Goten, Una ultima pregunta consegui esta Basic Stamp: Board of Education Development Board (USB)
con esa la puedo hacer…?
1:42:36 pm
oye necesito contruir un controlador automatico para regular las velocidades de un motor
necesito ayuda como le hago?
12:32:10 pm
necesito hacer con servo motor un control de camara filmadora arriba de una grua los que utilizan en tv, uno para el tilt y otro para el paneo pero no se como uno tiene que mover un peso de 10 kilos y otro de 5 kilos y tengan en forma controlada un movimiento cada uno de 360º.
2:03:10 pm
hay que conseguir una bateria de 6 voltios o 4 de 1,5? y en cualquiera de los dos casos como se montan
gracias
6:14:38 pm
me conectre para navegar durante un momento y estoy pegado al compu viendo su pagina que extraordinario super buena gracias por compartir sabiduria que dios los bendiga
7:11:01 pm
donde es posible conseguir el microcontrolador basic stamp mas barato
x k me gustaria hacer este proyecto en un taller de robotica
6:49:53 pm
guau…justo lo q yo quiero estudiar, pero me falta mucho para hacer eso…jejeje…no ntendi nada :S pero ya studiare eto y lo ntendere muy buen tutorial.
tengo una idea loka jejeje si el robot sigue la linea,y voy en la calle con una cinta de color, o algo q deje una linea y pongo a el robot en el piso y voy haciendo la liña x la calle…obtengo una mascota muy bien entrenada q va para donde yo quiera jejeje.
Saludos
1:16:02 am
disculpen esta muy bueno el tutorial, una pregunta ¿si eso lo pongo en un jugete me servira? por que no se hacer el autito ese qe sale jaja