Licznik impulsów na Atmega8- jakie oprogramowanie w Bascom?

$regfile = "m8def.dat"
$crystal = 8000000
Cursor Off
Dim Czestotliwosc As Long
Dim Licz_8ms As Byte
Config Portd.0 = Output
Config Portd.1 = Output
Config Portd.2 = Output
Config Timer0 = Timer , Prescale = 256
Config Timer1 = Counter , Edge = Falling
On Timer0 Czas
On Timer1 Zlicz
Enable Interrupts
Enable Timer0
Enable Timer1
Declare Sub Licz_cze                                        'Pomiar czasu
Do
Loop
End

Czas:
Load Timer0 = 250
Incr Licz_8ms
If Licz_8ms = 125 Then
   Licz_8ms = 0
   Stop Timer1
   Gosub Licz_cze
   Start Timer1
End If
Return

Sub Licz_cze
    Czestotliwosc = Czestotliwosc * 256
    Czestotliwosc = Czestotliwosc + Counter1
    If Czestotliwosc < 100 Then
      Reset Portd.0
      Set Portd.1
      Set Portd.2
    End If
    If Czestotliwosc > 100 Then
      If Czestotliwosc < 200 Then
         Reset Portd.1
         Set Portd.0
         Set Portd.2
      End If
    End If
    If Czestotliwosc > 200 Then
      Reset Portd.2
      Set Portd.0
      Set Portd.1
    End If
    Czestotliwosc = 0
    Counter1 = 0
End Sub

Zlicz:
Incr Czestotliwosc
Return