Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Sensores: El robot detecta la lnea por medio de sensores. Los ms comunes son los
sensores infrarrojos (luz invisible al ojo humano), que normalmente constan de un LED
infrarrojo y un fototransistor (como el sensor CNY70 que se ve en la figura) apuntando
hacia la superficie donde se encuentra la lnea. Mediante este sensor el robot diferencia
entre los colores negro y blanco.
Motores: El robot se mueve utilizando 2 motores DC con sus respectivas cajas reductoras
para que pueda mover su peso y las subidas o pendientes del recorrido. Generalmente se
alimentan entre 9 12V dependiendo del motor DC utilizado.
www.pavdre.blogspot.com
Tarjeta o Circuito de control: Se utiliza un Microcontrolador (PIC) que recibe las seales
de los sensores (blanco o negro) y enva otras seales a un driver L293D (amplificador de
corriente) que permite controlar los giros de los motores DC ante la trayectoria de la lnea.
Esta parte comanda todo el comportamiento del robot (similar al cerebro).
www.pavdre.blogspot.com
Los motores DC con sus respectivas cajas reductoras y ruedas estarn ubicadas en la
parte trasera del robot fijadas con tornillos o cintillos a una superficie plana de material
rgido como MICA, que le da una mejor presentacin al proyecto, pudiendo ser de otro
material como madera o tripley.
Muy cerca a los sensores estar ubicada una rueda loca que le permitir al robot tener
un punto de apoyo y facilidad en los giros durante la trayectoria.
Encima de la MICA ir fijada la tarjeta o circuito de control para que podamos visualizar
sus componentes y verificar su correcto funcionamiento.
Lnea
SENSOR DERECHO
SENSOR IZQUIERDO
RUEDA LOCA
MOTOR IZQUIERDO
www.pavdre.blogspot.com
MOTOR DERECHO
En las siguientes figuras veremos las 4 situaciones que presentarn los sensores del robot en
el recorrido de la pista:
a) Si el sensor izquierdo = Negro y el sensor derecho = Blanco:
AVANZA
MOTOR IZQUIERDO : AVANZA
MOTOR DERECHO : AVANZA
GIRA IZQUIERDA
MOTOR IZQUIERDO : Retrocede
MOTOR DERECHO : Avanza
www.pavdre.blogspot.com
GIRA DERECHA
MOTOR IZQUIERDO : Avanza
MOTOR DERECHO : Retrocede
GIRA DERECHA
MOTOR IZQUIERDO : Avanza
MOTOR DERECHO : Retrocede
www.pavdre.blogspot.com
RASTREADOR DE LNEA
Leyenda:
Configura puertos:
B = Blanco
N = Negro
Puerto A = Entradas
Puerto B = Salidas
SI = Sensor Izquierdo
SD = Sensor Derecho
SI
SI=N y SD=B ?
ROBOT AVANZA
NO
SI
SI=N y SD=N ?
ROBOT GIRA
DERECHA
NO
SI
SI=B y SD=B ?
ROBOT GIRA
IZQUIERDA
NO
SI
SI=B y SD=N ?
www.pavdre.blogspot.com
ROBOT GIRA
DERECHA
La velocidad del robot se puede modificar cambiando los valores de ACT e INACT. En el
programa figura ACT = 3 y INACT = 7, es decir la velocidad del robot ser del 30%, si
desea aumentar la velocidad al 50%, ACT = 5 y INACT = 5, siempre ambos valores deben
sumar 10.
PROGRAMA EN MICRO CODE STUDIO:
CMCON=7
TRISA=%11
TRISB=0
SYMBOL SI=PORTA.0
: SYMBOL SD=PORTA.1
SYMBOL EN1=PORTB.0
: SYMBOL EN2=PORTB.3
SYMBOL T1MI=PORTB.4
: SYMBOL T2MI=PORTB.5
: Y VAR BYTE
INICIO:
IF SI=0 AND SD=1 THEN
GOSUB AVANZA
ENDIF
www.pavdre.blogspot.com
; SI SENSOR DER = N
; ENTONCES ROBOT GIRA DERECHA
ENDIF
IF SI=1 AND SD=1 THEN
GOSUB GIRA_IZQ
; SI SENSOR IZQ= B
; ENTONCES ROBOT GIRA IZQUIERDA
ENDIF
IF SI=1 AND SD=0 THEN
GOSUB GIRA_DER
ENDIF
GOTO INICIO
AVANZA:
; REPITE PROGRAMA
; SECUENCIA PARA QUE ROBOT AVANCE
www.pavdre.blogspot.com
NEXT
FOR Y=1 TO INACT
EN1=0 : EN2=0
PAUSE 1
NEXT
RETURN
GIRA_IZQ:
www.pavdre.blogspot.com
El circuito consta de un bloque que regula el voltaje de entrada de una batera de 12V a
5V estabilizados para energizar al Microcontrolador, sensores y a los dems circuitos,
por ello podemos ver que se utiliz el regulador 7805 y otros dispositivos auxiliares.
El circuito de los sensores utiliz un C.I. 40106 que acondiciona la seal para poder
enviarla hacia el Microcontrolador. Adems cada sensor posee un Led indicador que si
est encendido, el sensor detecta Blanco y si se apaga detecta Negro.
www.pavdre.blogspot.com
10
El circuito del driver L293D se encargar de recibir las seales del Microcontrolador
para los giros y amplificar la corriente. Tambin se encargar de controlar los giros de
los motores DC del robot.
A continuacin se muestra el diseo de las pistas del circuito del robot en ARES:
PISTAS:
www.pavdre.blogspot.com
11
www.pavdre.blogspot.com
12