tester butelek

' tester pustych butelek

$regfile = "m8def.dat"                                      ' uC
$crystal = 4000000                                          ' taktowanie 4MHz

Config Portd = Output
Config Portb = Input

Config Adc = Single , Prescaler = Auto , Reference = Avcc

Dim Czujnik_1 As Single
Dim Czujnik_2 As Single
Dim Poot As Single
Dim W As Word

' Czujnik_1 - obecność butelki
' Czujnik_2 - brak szyjki


Const Granica = 500

Przycisk Alias Portb.0
Zielona Alias Portd.0
Czerwona Alias Portd.1
Silnik_a Alias Portd.2
Silnik_b Alias Portd.3

Set Przycisk
Set Zielona
Set Czerwona
Reset Silnik_a
Reset Silnik_b

Do
Gosub Wczytaj_stany
If Przycisk = 0 Then
Set Silnik_a
Reset Silnik_b
End If
If Przycisk = 0 And Czujnik_1 > Granica And Czujnik_2 > Granica Then
Reset Silnik_a
Reset Silnik_b
Reset Zielona
Set Czerwona
Wait 2

End If

If Przycisk = 0 And Czujnik_2 > Granica And Czujnik_2 < Granica Then
Reset Silnik_a
Reset Silnik_b
Set Zielona
Reset Czerwona
Wait 2

Else

Set Silnik_a
Reset Silnik_b
Set Zielona
Set Czerwona

End If

Loop

End



Wczytaj_stany:
Start Adc
W = Getadc(1)
W = Getadc(1)
Stop Adc
Czujnik_1 = W
Start Adc
W = Getadc(2)
W = Getadc(2)
Stop Adc
Czujnik_2 = W
Return