Czujnik parkowania deluxe

// Czujnik parkowania deluxe
// Jak zwykły czujnik parkowania, ale teraz widzisz odległość też na ekranie OLED.

#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

const int TRIG_PIN = 9;     // Trig z HC-SR04 na pin 9
const int ECHO_PIN = 10;    // Echo z HC-SR04 na pin 10
const int BRZECZYK_PIN = 8; // S brzęczyka na pin 8

Adafruit_SSD1306 ekran(128, 32, &Wire, -1);  // OLED: SDA = A4, SCL = A5

// Mierzy odległość w centymetrach
long zmierzOdleglosc() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  long czas = pulseIn(ECHO_PIN, HIGH, 30000);
  if (czas == 0) return 999;   // Brak echa: nic blisko
  return czas / 58;
}

// Pokazuje dużą odległość na ekranie, z paskiem pod spodem
void pokazOdleglosc(long odleglosc) {
  ekran.clearDisplay();
  ekran.setTextSize(2);
  ekran.setCursor(0, 0);
  if (odleglosc >= 999) {
    ekran.print(F("---"));
  } else {
    ekran.print(odleglosc);
    ekran.print(F(" cm"));
  }
  // Pasek: im bliżej, tym dłuższy
  int dlugosc = map(constrain(odleglosc, 0, 100), 0, 100, 128, 0);
  ekran.fillRect(0, 24, dlugosc, 8, SSD1306_WHITE);
  ekran.display();
}

void setup() {
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(BRZECZYK_PIN, OUTPUT);
  ekran.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  ekran.setTextColor(SSD1306_WHITE);
}

void loop() {
  long odleglosc = zmierzOdleglosc();
  pokazOdleglosc(odleglosc);

  if (odleglosc < 5) {
    digitalWrite(BRZECZYK_PIN, HIGH);   // Bardzo blisko: jeden długi dźwięk
    delay(100);
  } else if (odleglosc < 50) {
    digitalWrite(BRZECZYK_PIN, HIGH);   // Krótkie piknięcie
    delay(50);
    digitalWrite(BRZECZYK_PIN, LOW);
    delay(odleglosc * 10);              // Bliżej = szybsze pikanie
  } else {
    digitalWrite(BRZECZYK_PIN, LOW);
    delay(100);
  }
}