errorlevel -302 ; Turn off banking message
                ; known tested (good) code
                
;#########################
;## PROC DEFINITIONS	##
;#########################
;   Set User ID Memory
	__idlocs		0x55aa
;   Set configuration bits using definitions from the include file, p16f84.inc
	__config	_INTRC_OSC_NOCLKOUT & _WDT_OFF & _CP_OFF & _MCLRE_OFF
	
list p=12f629

; Include file, change directory if needed
include "p12f629.inc"


;#########################
;## PIN DEFINITIONS	##
;#########################
; GP5	OUT	LED1	(Active LOW)
; GP4	I/O			()
; GP3	INP			()
; GP2	I/O			()
; GP1	OUT	LED2	()
; GP0	OUT LED3	()
LED1_P		EQU	b'100011'


; OUTPUTs
LED1	EQU	GP5
LED2	EQU	GP1
LED3	EQU	GP0


; INPUTs

;#########################
;## CONSTANTS		##
;#########################

;#########################
;## GLOBAL REGISTERS	##
;#########################
count_l	EQU	0x20		; Low byte of counter
count_h EQU	0x21		; High byte of counter

;#########################
;## MACROS		##
;#########################
#define	PAGE0		bcf	STATUS,RP0	; [M] Switch to page 0 in RAM
#define PAGE1		bsf	STATUS,RP0	; [M] Switch to page 1 in RAM

LED1_ON macro				; [M] Turn on LED1
	bcf	GPIO,LED1
	endm
	
LED1_OFF macro				; [M] Turn off LED1
	bsf	GPIO,LED1
	endm

LED2_ON macro				; [M] Turn on LED2
	bcf	GPIO,LED2
	endm
	
LED2_OFF macro				; [M] Turn off LED2
	bsf	GPIO,LED2
	endm

LED3_ON macro				; [M] Turn on LED3
	bcf	GPIO,LED3
	endm
	
LED3_OFF macro				; [M] Turn off LED3
	bsf	GPIO,LED3
	endm
	
;###################################################################################
;###################################################################################
;####			S	T	A	R	T			####
;###################################################################################
;###################################################################################
;Initialization of basic registers
Reset_vector	org	0x0000
	goto	Init
	
Irq_vector	org	0x0004
	retfie

Init
; ##############
; Adjust osc calibration constant, read it from EEPROM



	PAGE1				; Set page 0
	call	0x3ff			
	movwf	OSCCAL			; Read osc calibration value and set it 
	PAGE0
	
	movlw	0x07
	movwf	CMCON	


	clrwdt				; Reset watchdog
;###############
; Set Inputs/Outputs
	PAGE1
	movlw	~(LED1_P)		; LED1 will be output
	movwf	TRISIO			; Set direction
	PAGE0
; Set GPIO
	movlw	0xfe
	movwf	GPIO			; Turn off LED1 and 2 leds, turn on LED3

;#######################################
; MAIN LOOP
;#######################################
M_L0:
	clrw
	movwf	count_l
	movlw	0x40
	movwf	count_h			; Set counter to 0x40
	btfss	GPIO,GP5
	goto	Led_off
	goto	Led_on
M_L1:
	incfsz	count_l			; inner loop
	goto	M_L1	
	incfsz	count_h			; outer loop
	goto 	M_L1	
	goto	M_L0


;###############
;Functions
;###############
Led_off:
	LED1_OFF
	LED2_OFF
	LED3_ON
	goto	M_L1

Led_on:
	LED1_ON
	LED2_ON
	LED3_OFF
	goto	M_L1
	
	end