Сравнение двух регистров (PIC16F877A)

P16f877A.inc
    __CONFIG    H'3F76' & _WDT_OFF
;***********************  Адреса памяти данных  *****************************************
 
DELAY_5mkc  equ         h'46'
Reg_1       EQU         h'47'   ;ТАЙМЕР
Reg_2       EQU         h'48'   ;ТАЙМЕР
Reg_3       EQU         h'49'   ;ТАЙМЕР
AKB1        equ         h'50'
AKB2        equ         h'51'
 
        org 0x000
        nop
        goto    START
        org 04h 
;**************************************************************************************
 
;************************   ОСНОВНАЯ ПРОГРАММА *****************************************
;****************************************************************************************
START:
    
        call    SET_BASIS       ;Вызов подпрограммы установки базисных значений
BEGIN:
 
        call    BLOK1           ; АКБ 1
        call    BLOK2           ; АКБ 2
 
 
goto    BEGIN   
 
;БАЗОВЫЕ ПАРАМЕТРЫ
        
SET_BASIS:
            bsf         STATUS,5    ; переход в Банк 1 
            movlw       b'00000001'
            movwf       TRISA
            clrf        TRISB
            bcf         STATUS,5    ; переход назад в Банк 0
            clrf        PORTB       ; очистка порта
 
BLOK1:
        ;реле нагрузки
        movlw       b'00100001' ; запись в аккумулятор
        movwf       PORTB       ; перенос из аккумулятора в порт
        call        Pause    
; ВЫЖИДАЕТСЯ ВРЕМЯ И ДЕЛАЕТСЯ ЗАМЕР ЧЕРЕЗ АЦП 
        call        ACP
        movwf       AKB1        ;Загружаем результат в регистр AKB1
        movlw       b'00000000' ; запись в аккумулятор
        movwf       PORTB       ; перенос из аккумулятора в порт
 
        return
BLOK2:
        ;реле нагрузки
        movlw       b'00100010' ; запись в аккумулятор
        movwf       PORTB       ; перенос из аккумулятора в порт
        call        Pause       ; переход на метку (с возвратом)
; ВЫЖИДАЕТСЯ ВРЕМЯ И ДЕЛАЕТСЯ ЗАМЕР ЧЕРЕЗ АЦП 
        call        ACP
        movwf       AKB2        ;Загружаем результат в регистр    AKB2
        movlw       b'00000000' ; запись в аккумулятор
        movwf       PORTB       ; перенос из аккумулятора в порт
        
        return
 
 
 
 
 
 
ACP:
        clrf    STATUS          ;Очищаем регистр STATUS
        bsf     STATUS,RP0      ;1-банк
        movlw   b'00000001'     ;все входа АЦП задействованы, "левое"выравнивание, Uоп=RA3
        movwf   ADCON1          ;Отправляем константу в регистр ADCON1 
        bcf     STATUS,RP0      ;0-банк
        movlw   b'11000001'     ;внутренний RC-генератор, AN0-канал, АЦП включен
        movwf   ADCON0          ;Отправляем константу в регистр ADCON0
        movlw   d'12'           ;Загружаем константу в w
        movwf   DELAY_5mkc      ;Отправляем константу в регистр DELAY_5mkc
        decfsz  DELAY_5mkc,1        ;DELAY_5mkc-1
        goto    $-1         ;Цикл на 1 строчку вверх
        bsf     ADCON0,GO_DONE  ;запуск АЦП
        btfsc   ADCON0,GO_DONE  ;ожидание конца преобразования
        goto    $-1             ;Цикл на 1 строку вверх
        movf    ADRESH,W        ;считывание результата в регистр
 
 return
 
 
 
 
Pause
       movlw       .85
            movwf       Reg_1
            movlw       .138
            movwf       Reg_2
            movlw       .3
            movwf       Reg_3
wr          decfsz      Reg_1, F
            goto        wr
            decfsz      Reg_2, F
            goto        wr
            decfsz      Reg_3, F
            goto        wr
            
            return
        end

  movf  AKB1,W
  bcf   STATUS,C
  subwf AKB2,W
  btfss STATUS,C
  goto  AKB2Bolshe
  movlw b'00000001'
  movwf PORTB
AKB2Bolshe:
  . . . . . . . .