ассемблер для PIC16

[BanDit]

Доброго времени суток!!! Нужна помощь с составлением кода для курсовой работы, есть алгоритм, но с кодом проблема,
Тема такая: Организация временной задержки малой длительности между событиями на основе таймера
Процессор Pic16F87
только что дошарил замутил так

#include 	p16f877.inc

TMP0	equ	20h		; Адрес переменной TMP0

BANK0	macro		; Установка Банка - 0
		bcf	STATUS,RP0
		bcf	STATUS,RP1
	endm
BANK1	macro		; Установка Банка - 1
		bsf	STATUS,RP0
		bcf	STATUS,RP1
	endm
         
            Основная программа
org	0x00		; адрес начала программы
	goto	START		; переход на метку START
	org	0x06		; адрес размещения основной программы

START:	BANK1
	bcf OPTION_REG,NOT_RBPU
	movlw	a'00001000'	; 4-й бит PORTA на вход
	movwf	TRISA	
	BANK0

BEGIN:	btfsc PORTA,4			; есть ли прерывание?
	goto $-1			; если нет то переход на шаг  назад
	call DELAY_SCAN			; задержка 20ms
	btfsc PORTA,4			; подтверждение нажатия кнопки
	goto BEGIN			; если нет то переход к началу

	btfss PORTA,4			; Появилось ли прерывание?
	goto $-1			; если нет то переход на шаг  назад

*******************  Подпрограмма задержки  ***************
DELAY_SCAN:
	movlw 	01h			;
	movwf	TMP0			; TMP0 = 00h
NEXT:	decfsz	TMP0,F			; TMP0 = TMP0 - 1
	goto	NEXT			; если Z = 0 то переход
	return

METKA:	
	end