Stacja lutownicza na Atmega8 z wyświetlaczem 7-segmentowym

Code Basic4GL - [expand]
$regfile = "m8def.dat"
 
$crystal = 1000000
 
Declare Sub Led_dec(byval Liczba As Word)
 
Config Portd = Output
Dataport Alias Portd
Config Pinb.2 = Output
Led1 Alias Portb.3
Config Pinb.1 = Output
Led2 Alias Portb.2
Config Pinb.0 = Output
Led3 Alias Portb.1
Config Pinb.3 = Output
Led4 Alias Portb.0
Portb.2 = 1
'Konfiguracja wyświetlacza
 
 
Config Pinc.3 = Output
Grzalka Alias Portc.3
Config Pinc.4 = Output
Led_usp Alias Portc.4
Config Pinc.5 = Output
Led_grz Alias Portc.5
Config Pinc.2 = Input
Set Portc.2
Uspienie Alias Pinc.2
'Konfiguracja podpiętych LEDów
 
 
 
 
Config Pinc.0 = Input
Config Pinc.1 = Input
Config Adc = Single , Prescaler = Auto , Reference = Avcc
Start Adc
'Konfiguracja wejść ADC
 
 
Config Timer0 = Timer , Prescale = 8
Enable Interrupts
Enable Timer0
On Timer0 Led
Dim Akt_led As Byte
Akt_led = 1
Dim Dane_led(4) As Byte
'Przerwania do obsługi wyświetlacza
 
 
Config Timer1 = Timer , Prescale = 64
Enable Timer1
On Timer1 Przerwt1
Start Timer1
'Konfiguracja licznika do chwilowego wyświetlania wartości nastawionej
 
Dim W As Word                                               'zmienna do odczytu nastawy potencjometru
Dim W1 As Word                                              'zmienna pomocnicza do wykrycia zmian nastawy potencjometru
Dim W2 As Word                                              'zmienna pomocnicza do wykrycia zmian nastawy potencjometru
Dim T As Word                                               'zmienna do odczytu pomiaru temperatury
Dim U As Single                                             'zmienna pomocnicza do pomiaru temperatury
Dim Wsk As Bit                                              'zmienna określająca co ma być wyświetlane pomiar/nastawa
Dim Usp As Bit                                              'zmienna określająca stan pracy praca/uspienie
'Deklaracja zmiennych
 
Usp = 1
Grzalka = 1
W1 = 0
'Wstępne ustawianie zmiennych
 
Do
  If Usp = 0 Then
   W = 100
   End If
   If Usp = 1 Then
   W = Getadc(0)
   W = W / 29
   W = W * 10
   W = W + 100
   End If
   'Pomiar wartości z potencjometru
 
 
   T = Getadc(1)
   U = T
   U = U / 1023
   U = U * 5
   T = U * 120
   'Pomiar temperatury i pomnożenie przez stałą termopary
 
   If W > W1 Or W < W2 Then
      Start Timer1
      Timer1 = 0
      Wsk = 1
      W1 = W + 10
      W2 = W - 10
   End If
   'Wykrywanie zmian nastawy potencjometru
 
   If Wsk = 1 Then
      Led_dec W
   End If
 
   If Wsk = 0 Then
      Led_dec T
      Waitms 200
   End If
   ' Wyświetlanie odpowiedniej wartości zmierzonej lub nastawionej
 
 
   If W > T Then
   Reset Grzalka
   Reset Led_grz
   End If
 
   If W <= T Then
   Set Grzalka
   Set Led_grz
   End If
   'Wlaczanie i wyłączanie grzałki i leda od grzałki
 
   If Uspienie = 0 Then
   Toggle Usp
   Waitms 300
   End If
   'Obsługa przycisku od uspienia
 
   Led_usp = Usp                                            'Obsługa Leda od uśpienia
 
 
Loop
 
End
 
Przerwt1:
   Wsk = 0
   Stop Timer1
Return
'Przerwanie Timera1 do chwilowego wyświetlania temp nastawionej
 
 
'!!! PONIŻEJ OBSŁUGA WYŚWIETLACZA W PRZERWANIU Z TIMERA !!!
 
Sub Led_dec(byval Liczba As Word)
   Local Reszta As Word
   Reszta = Liczba Mod 10
   Dane_led(4) = Lookup(reszta , Led_cyfry)
   Liczba = Liczba / 10
   Reszta = Liczba Mod 10
   Dane_led(3) = Lookup(reszta , Led_cyfry)
   Liczba = Liczba / 10
   Reszta = Liczba Mod 10
   Dane_led(2) = Lookup(reszta , Led_cyfry)
   Liczba = Liczba / 10
   Reszta = Liczba Mod 10
   Dane_led(1) = Lookup(reszta , Led_cyfry)
End Sub
'wyciąga poszczególne cyfry z liczby do wyświetlenia
 
 
Led:
   Set Led4
   Set Led3
   Set Led2
   Set Led1
   Dataport = Dane_led(akt_led)
   Select Case Akt_led
   Case 1 : Reset Led1
   Case 2 : Reset Led2
   Case 3 : Reset Led3
   Case 4 : Reset Led4
   End Select
   Incr Akt_led
   If Akt_led > 4 Then Akt_led = 1
Return
'obsługa wyświetlacza i wyświetlenie liczb
 
 
Led_cyfry:
Data &B11000000                                             '0
Data &B11111001                                             '1
Data &B10100100                                             '2
Data &B10110000                                             '3
Data &B10011001                                             '4
Data &B10010010                                             '5
Data &B10000010                                             '6
Data &B11111000                                             '7
Data &B10000000                                             '8
Data &B10010000                                             '9
'wzory cyfr 0-9