Pic16f84a con display 7 elementos multiplexado y proton

Me estoy rompiendo la cabeza intentando hacer funcionar un display de 7 elementos multiplexado de 2 dígitos con el pic16f84a.
Lo hice funcionar correctamente con loops, donde cada loop era un dígito desde el 00 hasta el 99 pero cuando llegue a la mitad, llegue al tope de líneas de código y tuve que cambiar de idea.
Ahora estoy probando este código y solo me prende el display en 00.
Device = 16F84A
XTAL = 4        
TRISB=0         
TRISA=15        
Dim CONTADOR As Word  
Symbol Q1 = PORTB.6
Symbol Q0 = PORTB.7
Dim UNIDAD As Byte
Dim DECENA As Byte
PORTB=0
INICIO:
        DelayMS 100
CONTADOR = CONTADOR + 1
If CONTADOR >99  Then CONTADOR=0
    DelayMS 5
PORTB= 16 + Dig 0, CONTADOR
DelayMS 5
PORTB= 32 + Dig 1, CONTADOR
DelayMS 5
PORTB=0
DelayMS 5
GoTo INICIO
End

Este código lo estoy intentando adaptar de uno de 4 dígitos que encontré para darme una idea.
En proteus se ve así.

¿En qué estoy equivocado en el código? ¿O todo esta mal?

Añade tu respuesta

Haz clic para o