// Definovanie pinov pre senzor HC-SR04
const int trigPin = 34;
const int echoPin = 32;

// Premenné na ukladanie údajov
long duration;
int distance;

void setup() {
  // Nastavenie pinu Trig ako výstupu a Echo ako vstupu
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  
  // Inicializácia sériovej komunikácie
  Serial.begin(9600);
}

void loop() {
  // Uistíme sa, že Trig je LOW
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  
  // Nastavíme Trig na HIGH na 10 mikrosekúnd, aby sme poslali ultrazvukovú vlnu
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Zmeráme dĺžku trvania signálu na Echo pine (v mikrosekundách)
  duration = pulseIn(echoPin, HIGH);

  // Prepočítame vzdialenosť na základe trvania (v cm)
  distance = duration * 0.034 / 2;

  // Vypíšeme vzdialenosť do sériového monitora
  Serial.print("Vzdialenosť: ");
  Serial.print(distance);
  Serial.println(" cm");

  // Krátka pauza medzi meraniami
  delay(500);
}