Programacion de pic para carro tipo tanque

LÓGICA CARRO TIPO TANQUE

Buenas tardes compañeros, no se si estoy en la sección correcta, pero aquí lo posteo, si algo me avisan, y bueno directo al grano. Hace algún tiempo vengo construyendo un carro de sumo para peleas (concurso que hacen en la universidad). El problema que tengo es que lo he venido mejorando y ahora lo tengo tipo tanque con orugas y la programación de pic que tengo, ya no me sirve ya que las orugas al hacer el giro, deben girar juntas pero en sentidos contrarios, y yo de pics solo sé que se pueden programar y un amigo fue el que me quemo el programa.

Hay le dejo adjunta una tabla con la configuración que necesito y un pequeño plano de como tengo armada la parte electronica en general y si me pueden colaborar con la programacion, pues me serviría de mucho.

Aquí les dejo el código que tiene actualmente tiene el pic:

LIST P=16F84A
#include <p16f84A.inc>
__CONFIG _CP_OFF & _WDT_OFF & _PWRTE_OFF & _XT_OSC
RADIX HEX

pto_a EQU 0x05
pto_b EQU 0x06
W EQU 0
estado EQU 0x03
unidades EQU 25h
decenas EQU 26H
total equ 27h
conta1 equ 28h
c3 equ 29h
c2 equ 30h
c1 equ 31h
ORG 00
goto emp
org 05

emp clrf pto_a
clrf pto_b
bsf estado,5
movlw 9f
movwf 06h
movlw 0x00
movwf pto_b
movlw 0xff
movfw pto_a
movlw 0x00
movwf total
bcf estado,5
GOTO t1

t1 btfsc pto_a,3
goto t14
goto t2

t2 btfsc pto_a,2
goto t9
goto t3

t3 btfsc pto_a,1
goto t6
goto t4

t4 btfsc pto_a,0
goto t5
goto t1

t5 movlw 0x02
movwf pto_b
goto t1

t6 btfsc pto_a,0
goto t8
goto t7

t7 movlw 0x14
movwf pto_b
goto t1

t8 movlw 0x02
movwf pto_b
goto t1

t9 btfsc pto_a,1
goto t12
goto t10

t10 btfsc pto_a,0
goto t1
goto t11

t11 movlw 0x10
movwf pto_b
goto t1

t12 btfsc pto_a,0
goto t1
goto t13

t13 movlw 0x04
movwf pto_b
goto t1

t14 btfsc pto_a,2
goto t1
goto t15

t15 btfsc pto_a,1
goto t16
goto t16

t16 btfsc pto_a,0
goto t18
goto t17

t17 movlw 0x28
movwf pto_b
goto t1


t18 movlw 0x18
movwf pto_b
goto t1



end

De antemano muchas gracias y en espera de su colaboración, si necesitan mas información adicional o alguna otra cosa me comentan. Gracias.
 

Adjuntos

  • Parte electronica.png
    Parte electronica.png
    13.7 KB · Visitas: 12
  • tabla.jpg
    tabla.jpg
    43.4 KB · Visitas: 7
Atrás
Arriba