(Bascom) Problem z programem do ultradźwiękowegoczujnika odleglości (HC-SR04)

[mikolaj45412]

Mam problem z programem nie działa on tak jak należy. Jego zadaniem jest zaświecenie diody Dzz i Dz i zgaszenie diodyDbb wtedy gdy czujnik nie wykrywa przeszkody, natomiast gdy ją wykryje ma zaświecić się dioda Dbb i zgasić diody Dzz i Dz.

Po wgraniu programu świecą się diody Dzz i Dz, tylko gdy umieszczę przeszkodę dioda Dbb nie świeci się a diodyDzz i Dz nadal się świecą. Proszę o sprawdzenie programu i poprawienie błędów.

Echo - PD6

Trig -PD7

Dz - Portc.5

Dzz - Portc.4

Dbb - Portd.0

$regfile = "m8def.dat"
$crystal = 1000000
$baud = 9600
Config Portc.5 = Output
Config Portc.4 = Output
Config Portd.0 = Output
Config Portd.7 = Output
Config Portd.6 = Input
Trig Alias Portd.7
Dz Alias Portc.5
Dzz Alias Portc.4
Dbb Alias Portd.0
Dim S As Word
Dim R As Single

Do

Pulseout Portd , 7 , 30
Pulsein S , Pind , 6 , 1
R = S * 0.1725
Print R
Waitms 50

If Pind.6 = 0 Then
  Gosub Diody_zielone
End If
If Pind.6 = 1 Then
  Gosub Dioda_biala
End If
Loop
Diody_zielone:
Dz = 1
Dzz = 1
Dbb = 0                                                      
Return

Dioda_biala:
Dbb = 1
Dzz = 0
Dz = 0
Return

End

[Sabre]

mikolaj45412, a po co zakładałeś 2 konto? Przecież masz już taki temat :

https://www.forbot.pl/forum/topics40/ultradzwiekowy-czujnik-odleglosci-hc-sr04-program-bascom-vt10882.htm