Ultrasonic sensor structure

const int TRIG  = 6;
const int ECHO  = 7;
const int BUZZER = 4;
const int PIN_R = 0;
const int PIN_G = 1;
const int PIN_B = 2;

void setup() {
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  pinMode(BUZZER, OUTPUT);
  pinMode(PIN_R, OUTPUT);
  pinMode(PIN_G, OUTPUT);
  pinMode(PIN_B, OUTPUT);
  Serial.begin(9600);
}

long measurePulse() {
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);

  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);

  return pulseIn(ECHO, HIGH);
}

void setColor(int r, int g, int b) {
  // --- sem skopírujte funkciu z predchádzajúcej úlohy ---
}

void playNote(int note) {
  // --- sem skopírujte funkciu z predchádzajúcej úlohy ---
}

void loop() {
  long trvanie = measurePulse();
  // Vzdialenosť = (čas * rýchlosť zvuku) / 2
  float vzdialenost = 0; //doplň

  Serial.print("Vzdialenosť: ");
  Serial.print(vzdialenost);
  Serial.println(" cm");

  if (vzdialenost > 30) {
    // --- doplňte: zelená, ticho ---
  } else if (vzdialenost > 10) {
    // --- doplňte: žltá, pomalé pípanie ---
  } else {
    // --- doplňte: červená, rýchle pípanie ---
  }
}