Arduino czujnik ultradźwiękowy z 2 diodami LED , schemat +kod z wyjaśnieniem

W tym poście chciałbym przedstawić schemat i omówić kod w języku C . Jest to dosyć proste więc myślę ,że każdy zrozumie .
Na początek rzućmy okiem na cały układ :

Zielona dioda(odległość większa lub równa 20 cm):

Czerwona dioda(odległość mniejsza od 20 cm)

a oto schemat :

Ja użyłem pinów 12,11 do czujnika odległości i 2,4 do diod ale oczywiście można to dostosować pod siebie , należy jednak pamiętać aby w kodzie zdefiniować te porty.
Kod z wyjaśnieniem:
#define trigPin 12
#define echoPin 11
#define LED_zielona 2
#define LED_czerwona 4
void setup() {
Serial.begin (9600);
pinMode(trigPin, OUTPUT); //Pin, wyjście
pinMode(echoPin, INPUT); //Pin, wejście
}

void loop() {
{Serial.print (zmierzOdleglosc()); // wyświetlane odległości w konsoli programu
Serial.println(" cm od przeszkody");
delay(100);}//odczekaj 100ms

if( zmierzOdleglosc() >= 20)//jeśli odległość jest większa bądź równa 20 wtedy zapala się zielona dioda
{
digitalWrite(LED_zielona,HIGH);//załącza się stan wysoki czyli nie płynie prąd
digitalWrite(LED_czerwona,LOW);//załącza się stan niski czyli nie płynie prąd
delay(500);//odczekaj 500ms
}

if( zmierzOdleglosc() < 20)// jeśli odległość jest mniejsza niż 20 wtedy zapala się czerwona dioda
{
digitalWrite(LED_czerwona,HIGH);//załącza się stan wysoki czyli  płynie prąd
digitalWrite(LED_zielona,LOW);}//załącza się stan niski czyli nie płynie prąd
}

int zmierzOdleglosc(){
long czas, dystans;
pinMode(LED_zielona,OUTPUT);//definiujemy pin jako wyjście
pinMode(LED_czerwona,OUTPUT);//definiujemy pin jako wyjście
digitalWrite(trigPin, LOW);// załącza się stan niski czyli nie płynie prąd
delayMicroseconds(2);//odczekaj 2 us
digitalWrite(trigPin, HIGH);//załącza się stan wysoki czyli płynie prąd
delayMicroseconds(10);//odczekaj 10 us
digitalWrite(trigPin, LOW);//załącza się stan niski czyli nie płynie prąd

czas = pulseIn(echoPin, HIGH);//funkcja mierząca czas w którym dźwięk z nadajnika trafił do odbiornika
dystans = czas * 0.017;//mnożymy tutaj czas[uS] przez prędkość dźwięku [m/uS]

return dystans;}

Dziękuję za uwagę i zapraszam do dyskusji .