;PROGRAMA QUE CONTROLA GIROS DE MOTORES PARA ROBOT SEGUIDOR DE LINEA negra
;--------------------------------------------------------------------------------------------------------
LIST P= 16f84A
INCLUDE<P16F84A.inc>
tmr0_opt EQU 1h ;Registro compartido para TMR0(Banco 0) y OPTION_REG(Banco 1)
porta equ 05h ;registro del puerto A
portb equ 06h ;registro del puerto B
org 0x00
goto inicio
inicio bsf STATUS,RP0 ;se ubica en el segundo banco de la RAm
movlw B'11111'
movwf PORTA ;se programan los pines del puerto A
movlw B'00000000'
movwf PORTB ;se programan los pines del puerto B
movlw 82h
movwf tmr0_opt
bcf STATUS,RP0 ;se ubica en el primer banco de la memoria RAM
PREGUNTA
movlw b'00101' ;activa bit 0 y 2 indica gire atras
subwf PORTA
btfsc STATUS,2
goto ATRAS
movlw b'00001' ;activa bit 0 para que gire derecha
subwf PORTA
btfsc STATUS,2
goto DERECHA
movlw b'00100' ;activa bit 2 para que gire izquierda
subwf PORTA
btfsc STATUS,2
goto IZQUIERDA
movlw b'00000' ; bit en ceros para que siga adelante el carro
subwf PORTA
btfsc STATUS,2
goto ADELANTE
ATRAS
movlw b'00001010' ;bit 1 y 3 se activan en salida portb
movwf PORTB
bcf STATUS,2
goto PREGUNTA
DERECHA
movlw b'00000110' ;bit 1 y 2 se activan en salida portb
movwf PORTB
bcf STATUS,2
goto PREGUNTA
ADELANTE
movlw b'00000101' ;bit 0 y 2 se activan en salida portb
movwF PORTB
bcf STATUS,2
goto PREGUNTA
IZQUIERDA
movlw b'00001001' ;bit 0 y 3 se activan en salida portb
movwF PORTB
bcf STATUS,2
goto PREGUNTA
END
ojala les sirva este programa en asm solo lo cargan al pic 16f84a con sus respectivos elementos y funcionara bn.....suerte!!!!!
Ver el archivo adjunto simulacion proteus seguidor listo.rar
programa ejecutado en mplab ide v8.1 en mayor v. tambien les corre!!!!! buena suerte!!
se utilizaran dos sensores cny70
este circuito es el que va a utilizar en el sensado de los dos cny70 ojo este es para un solo cny70 pero solo es adicionarle las misma conexiones ya que ese circuito integrado trabaja la otra parte o mejor el otro lado de pines igual no hay ningun problema.......ojala les sirva!!!!!