Servo structure

#include <Servo.h>

const int TRIG       = 6;
const int ECHO       = 7;
#define SERVO_LAVY   12
#define SERVO_PRAVY  13

Servo servoLavy;
Servo servoPravy;

void setup() {
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  servoLavy.attach(SERVO_LAVY, 500, 2500);
  servoPravy.attach(SERVO_PRAVY, 500, 2500);
  stoj();
  Serial.begin(9600);
}

long measurePulse() {
  // --- skopírujte z predchádzajúcej úlohy ---
}

void stoj() {
  servoLavy.write(90);
  servoPravy.write(90);
}

void vpred() {
  // --- doplňte ---
  // Nápoveda: ľavé a pravé koleso sú zrkadlovo otočené!
}

void vzad() {
  // --- doplňte ---
}

void loop() {
  long trvanie = measurePulse();
  float vzdialenost = 0; // --- doplňte výpočet ---

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

  if (vzdialenost > 30) {
    // --- doplňte ---
  } else if (vzdialenost > 10) {
    // --- doplňte ---
  } else {
    // --- doplňte ---
  }

  delay(50);
}