; Pulsgivare
;INT0 = PD2 =   Trycksensor
;INT1 = PD3 =   Terminal B
;       PD4 =   Terminal A
;--- INITERING INTERRUPTS ---
INTINIT:    cli
            ldi     WREG, 0x00          ;Sätt controllDDRA
            out     DDRD,WREG
            ldi     WREG, 0b00000100
            out     PORTD, WREG
            ldi     WREG, 0xC0
            out     GIMSK, WREG
            ldi     WREG, 0x06
            out     MCUCR, WREG
            sei
            ret


;--- Tryckknappen ---
EXT_INT0:
            push    TEMP
            in      TEMP, SREG
            sbr     PULS, TRYCK
        ;   ldi     ZH, high(2*STRINGTEST)          ; tar in data från table -> Z
        ;   ldi     ZL, low(2*STRINGTEST)
        ;   rcall   LCDPRINT
        ;   ldi     WREG, 0b00000100
        ;   out     PORTB, WREG
            out     SREG, TEMP
            pop     TEMP
            reti

;--- Vridet ---
EXT_INT1:
            push    TEMP
            push    WREG
            push    TEST

            in      TEMP, SREG
            in      TEST, PIND
            andi    TEST, 0b00011000
            cpi     TEST, 0b00011000
            breq    HOGERVRID
            cpi     TEST, 0b00000000
            breq    HOGERVRID
            cpi     TEST, 0b00001000
            breq    VANSTERVRID
            cpi     TEST, 0b00010000
            breq    VANSTERVRID
VRIDKLAR:   out     SREG, TEMP
            pop     TEST
            pop     WREG
            pop     TEMP
            reti

VANSTERVRID:sbr     PULS, VANSTER
            ldi     ZH, high(2*STRINGVT)            ; tar in data från table -> Z
            ldi     ZL, low(2*STRINGVT)
            rcall   LCDPRINT
            rjmp    VRIDKLAR
HOGERVRID:  sbr     PULS, HOGER
            ldi     ZH, high(2*STRINGHT)            ; tar in data från table -> Z
            ldi     ZL, low(2*STRINGHT)
            rcall   LCDPRINT; KOMMER ALLTID HIT DIN DUMMA FAN!
            rjmp    VRIDKLAR

;--- OUTPUT ---
VRIDEN:
            cpi     PULS, TRYCK
            breq    TRYCKT
            cpi     PULS, HOGER
            breq    VHOGER
            cpi     PULS, VANSTER
            breq    VVANSTER
            rjmp    DVRIDEN

TRYCKT:     ldi     ZH, high(2*STRINGTEST)          ; tar in data från table -> Z
            ldi     ZL, low(2*STRINGTEST)
            rcall   LCDPRINT
            cbr     PULS, $FF
            rjmp    DVRIDEN

VHOGER:
            ldi     ZH, high(2*STRINGH)         ; tar in data från table -> Z
            ldi     ZL, low(2*STRINGH)
            rcall   LCDPRINT
            cbr     PULS, $FF
            rjmp    DVRIDEN

VVANSTER:
            ldi     ZH, high(2*STRINGV)         ; tar in data från table -> Z
            ldi     ZL, low(2*STRINGV)
            rcall   LCDPRINT
            cbr     PULS, $FF
            rjmp    DVRIDEN

/*;--- KLOCKA ---
TIM0_OVF    push    TEMP
            push    WREG
            in      TEMP, SREG

            out     SREG, TEMP
            pop     WREG
            pop     TEMP
            reti
*/