converting to bcd

MOVLW	B'00000111'
MOVWF	BINARY
CALL 	BIN2BCD  
MOVF	TENS_AND_ONES 
ANDLW 	B'00001111'
CALL	LOOKUP_TABLE 
CALL 	DISPLAY
RRF	TENS_AND_ONES,4
MOVF	TENS_AND_ONES,W 
CALL	LOOKUP_TABLE
CALL 	DISPLAY
GOTO	$

BIN2BCD:  
 CLRF    HUNDREDS
 SWAPF   BINARY,W    ; swap the nibbles
 ADDWF   BINARY, W   ; so we can add the upper to the lower
 ANDLW   B'00001111' ; lose the upper nibble (W is in BCD from now on)
 BTFSC 	 STATUS,DC	 ; if we carried a one (upper + lower > 16)
 ADDLW   0x16        ; add 16 (the place value) (1s + 16 * 10s)
 BTFSC   STATUS,DC   ; did that cause a carry from the 1's place?
 ADDLW   0x06        ; if so, add the missing 6 (carry is only worth 10)
 ADDLW   0x06        ; fix max digit value by adding 6
 BTFSS 	 STATUS, DC  ; if was greater than 9, DC will be set
 ADDLW  -0x06        ; if if it wasn't, get rid of that extra 6
        
 BTFSC   BINARY,4       ; 16's place
 ADDLW   0x16 - 1 + 0x6  ; add 16 - 1 and check for digit carry
 BTFSC   STATUS, DC
 ADDLW  -0x06        ; if nothing carried, get rid of that 6
        
 BTFSC   BINARY, 5      ; 32nd's place
 ADDLW   0x30         ; add 32 - 2
        
 BTFSC   BINARY, 6      ; 64th's place
 ADDLW   0x60        ; add 64 - 4
        
 BTFSC   BINARY, 7  ; 128th's place
 ADDLW   0x20        ; add 128 - 8 % 100
        
 ADDLW   0x60        ; has the 10's place overflowed?
 RLF     HUNDREDS, F ; pop carry in hundreds' LSB
 BTFSS   HUNDREDS, 0 ; if it hasn't
 ADDLW  -0x60       ; get rid of that extra 60
        
 MOVWF   TENS_AND_ONES   ; save result
 
 BTFSC   BINARY,7       ; remeber adding 28 - 8 for 128?
 INCF    HUNDREDS, F ; add the missing 100 if bit 7 is set
        
 RETURN             ; all done!

;Byte to BCD or ASCII into ascbfr, from Byte in binvall

    list    p=16f876a
    #include <p16f876A.inc>

    errorlevel -302, -207

    __config _CP_OFF & _XT_OSC & _PWRTE_ON  & _WDT_OFF & _LVP_OFF

temp1    equ     0x21
temp2    equ     0x22
binvall equ     0x23
binvalm equ    0x24

 
ascbfr2 equ     0x40
ascbfr1 equ     0x41
ascbfr0 equ     0x42



    org 0x0000
    goto test
    org 0x0004
    retfie
    
test:
    movlw     .123
    movwf    binvall
    call    bin2asc
    
trap:    goto trap

;convert 8 bit bin to 3 asci in ascbfr0
bin2asc:
    clrf    ascbfr2
    clrf      ascbfr1
    clrf    ascbfr0;lsd
          
        movlw   .8 
    movwf   temp1

bitloop:;shift msb into carry
        rlf     binvall,F 
        
        movlw   ascbfr0    ;0=lsd 1st
        movwf   FSR    ;fsr=pointer to digits
        movlw   0X03    ;digits to do
        movwf   temp2
adjloop:
        rlf     INDF,F    ;shift digit 1 bit left
        movlw   0X0A
        subwf   INDF,W    ;check and adjust for decimal overflow
        btfsc   STATUS,C
        movwf   INDF

        decf    FSR,F;incf=msd 1st next digit
        decfsz  temp2,F
        goto    adjloop
        decfsz  temp1,F;next bit
        goto    bitloop

    ;return from here if BCD only
    
        movlw    0X30;make asci
    iorwf   ascbfr2,F
    iorwf   ascbfr1,F
    iorwf   ascbfr0,F
    return 

    end

;******************************************************************
;
;  8-bit to 3 digit half-packed BCD (isochronous)
;
;   input: WREG, 0x00..0xFF, 0..255
;  output: tens, 0x00..0x25, packed bcd hundreds and tens
;          ones, 0x00..0x09
;
;  26 words/cycles (isochronous), not including call and return
;
    radix    dec

        clrf    tens            ;
        addlw   -200            ; W = W - 200
        rlf     tens,F          ; pick up Carry result
        btfss   tens,0          ; borrow? no, skip, else
        addlw   200             ; add 200 back
        addlw   -100            ; subtract 100
        rlf     tens,F          ; pick up Carry result
        btfss   tens,0          ; borrow? no, skip, else
        addlw   100             ; add 100 back
        addlw   -80             ;
        rlf     tens,F          ;
        btfss   tens,0          ;
        addlw   80              ;
        addlw   -40             ;
        rlf     tens,F          ;
        btfss   tens,0          ;
        addlw   40              ;
        addlw   -20             ;
        rlf     tens,F          ;
        btfss   tens,0          ;
        addlw   20              ;
        addlw   -10             ;
        rlf     tens,F          ;
        btfss   tens,0          ;
        addlw   10              ;
        movwf   ones            ;
        return                  ;