#include "p18F4520.inc"
    
    CONFIG OSC = HS
    CONFIG PWRT = OFF
    CONFIG WDT = OFF
    CONFIG PBADEN = OFF
    CONFIG LVP = OFF
    
	org 0x000000

PORST	GOTO MAIN

;---------DELAY 80 ms------------------------
IDSHORT equ	0x07D
IDLONG	equ	0x07E
	
ED80MS	CLRF	IDSHORT
		CLRF	IDLONG
LDLOOP	DECFSZ	IDSHORT
		GOTO	LDLOOP
		DECFSZ	IDLONG
		GOTO	LDLOOP
		RETURN
;----END OF DELAY SUBROUTINE-----------------
		org 0x000020
	
MAIN	BSF  TRISA, 0	   ; RA0 = input for analog
		BCF  TRISA, 1	   ; RA1 = output for LED
		CLRF TRISD	   ; Port D I/O = out
		BSF  PORTA, RA1	   ; kolumn 1 på
		CLRF PORTD	   ; alla rader av
	
		MOVLW 0x01
		MOVWF ADCON0
		MOVLW 0x0E
		MOVWF ADCON1
		MOVLW 0x12
	
OVER	CALL	ED80MS
		BSF	ADCON0,GO
BACK    BTFSC	ADCON0,DONE
		BRA	BACK
	
		CALL	COMVAL	    ;Anropa subrutiner som jämnför vilket intervall
		CALL	ED80MS
		NOP
		NOP
		BRA	OVER
		
	;*******VÄRST SUBRUTINEN!*********
	COMVAL	CLRF	PORTD
	MOVLW	0xE0		; Intervall 224-255
	CPFSLT	ADRESH		; Om mindre..
	BSF	PORTD, 7		; ..släck!
		
	MOVLW	0xC0		; Intervall 192
	CPFSLT	ADRESH		; Om mindre..
	BSF	PORTD, 6		; ..tänd!
	MOVLW	0xDF		;      till 223
	CPFSLT	ADRESH		; Om större..
	BCF	PORTD, 6		; ..släck!
	
	MOVLW	0xA0		; Intervall 160
	CPFSLT	ADRESH		; Om mindre..
	BSF	PORTD, 5		; ..tänd!
	MOVLW	0xBF		;      till 191
	CPFSLT	ADRESH		; Om större..
	BCF	PORTD, 5		; ..släck!
	
	MOVLW	0x80		; Intervall 128
	CPFSLT	ADRESH		; Om mindre..
	BSF	PORTD, 4		; ..tänd!
	MOVLW	0x9F		;      till 159
	CPFSLT	ADRESH		; Om större..
	BCF	PORTD, 4		; ..släck!
	
	MOVLW	0x60		; Intervall 96
	CPFSLT	ADRESH		; Om mindre..
	BSF	PORTD, 3		; ..tänd!
	MOVLW	0x7F		;      till 127
	CPFSLT	ADRESH		; Om större..
	BCF	PORTD, 3		; ..släck!
	
	MOVLW	0x40		; Intervall 64
	CPFSLT	ADRESH		; Om mindre..
	BSF	PORTD, 2		; ..tänd!
	MOVLW	0x5F		;      till 95
	CPFSLT	ADRESH		; Om större..
	BCF	PORTD, 2		; ..släck!
	
	MOVLW	0x20		; Intervall 32
	CPFSLT	ADRESH		; Om mindre..
	BSF	PORTD, 1		; ..tänd!
	MOVLW	0x3F		;      till 63
	CPFSLT	ADRESH		; Om större..
	BCF	PORTD, 1		; ..släck!
	
	MOVLW	0x1F
	CPFSGT	ADRESH		; Om större hoppa..
	BSF	PORTD, 0		; ..annars tänd!
	
	RETURN
	;*********SLUT PÅ ELÄNDET************

	end