Jak uruchomić wysoką częstotliwość PWM na ATtiny45? Kod nie działa poprawnie

Cytat:

.include "tn45def.inc"


.equ SYS_FREQ = 8
.def dane = r20
.def ah = r25 ;wskaznik adresu dla eeprom szeregowego MSB
.def al = r24 ;LSB



.cseg

.org 0x000
rjmp reset
.org 0x004
rjmp tc1_ovf ;Przerwanie od przepelnienia T1
reset:
ldi r16,low(ramend) ;***Init Stosu***
out spl,r16

sbi ddrb,1 ;***Init Portow***
;PB1 pracuje jako wyjscie fastPWM
cbi ddrb,2 ;PB2 pracuje jako we (przycisk)
sbi portb,2 ;z podciaganiem
sbi ddrb,3 ;PB3 jako wyjscie -> SCL
sbi ddrb,4 ;PB4 jako wyjscie -> SDA

;***Init Tajmera1***

ldi r16,1<<PLLE ;-----Inicjalizacja PLL----
out PLLCSR,r16 ;PLL enable

waitPLL:
in r16, PLLCSR ;Czekaj na odpalenie PLL (approx. 100ms)
sbrs r16, PLOCK
rjmp waitPLL


in r16,PLLCSR
ori r16,1<<PCKE
out PLLCSR,r16 ;Odpal PLL jako zegar dla PWM
;---------------------------
ser r16
out OCR1C,r16 ;Rozdzielczosc PWM = 8b
ldi r16,1<<PWM1A | 1<<COM1A1 | 1<<CS10 ;| 1<<CS10
out TCCR1,r16 ;Tryb fast PWM_A aktywny
;Wy OC1A (PB1) ustawiane dla TCNT1 = 0x01
;Zerowane dla zgodnego porownania TCNT1 z OCR1A
;TOP = OCR1C
;Preskaler = 1, Tajmer start

ldi r16,1<<TOIE1 ;***Init Masek Przerwan***
out TIMSK,r16 ;Zezwolenie na przerwanie od przepelnienia T1
sei ;Globalne zezwolenie na przerwania

clr al ;***Init rejestrow***
clr ah

rcall czytaj_bajt ;odczytany bajt znajduje sie w "dane"

stop:
rjmp stop

;****************Procedury Obslugi Przerwan*******************

tc1_ovf:
out OCR1A,dane
rcall czytaj_bajt
reti