.include "m32def.inc"
.def licznik1 = R21
.def licznik2 = R22
.def licznik3 = R23
ldi R16, high(RAMEND)
out SPH, R16
ldi R16, low(RAMEND)
out SPL, R16 // deklaracja stosu
ldi ZH, high(Opoznienie)
ldi ZL, low(Opoznienie)
ldi R16, 0xFF;
out DDRA, R16; // ustawienie portu A jako wyjściowego
ldi R16, 0x00;
out DDRC, R16;
ldi R24, 0x00;
out PORTA,R24


Klawisz:
ldi R17,0xFF
out PORTC,R17
in R17, PINC
sbrs R17, 0
rjmp Wcisnieto
rjmp Klawisz



Opoznienie:
ldi licznik3, 5
Loop:
ldi licznik2, 200
Loop0:
ldi licznik1, 160
Loop1:
dec licznik1
brne Loop1
dec licznik2
brne Loop0
dec licznik3
brne Loop
ret

Wcisnieto:
ldi R19, 0x00;
out PORTA, R19
ldi R19, 0x00
push R19
ldi R19,0b00000001
push R19
ldi R19,0b00000011
push R19
ldi R19,0b00000111
push R19
lsl R19
push R19
lsl R19
push R19
lsl R19
push R19
lsl R19
push R19
lsl R19
push R19
lsl R19
push R19
lsl R19
push R19
lsl R19
rjmp Wyciaganie

Wyciaganie:
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall
pop R20
out PORTA, R20
icall

rjmp Klawisz