#include <NewPing.h>
#include <Servo.h>
/* **************************************************************** */

Servo myservo;
NewPing metr(trig_pin, echo_pin, max_distance);

/* **************************************************************** */

int posit = 0;
int echo_pin = 40;
int trig_pin = 50;
int max_distance = 300;
float distance; // float může být zaměněn za int, protože knihovna umí pouze celá čísla

/* **************************************************************** */

void setup()
{
  Serial.begin(9600);
  myservo.attach(30);
  pinMode(echo_pin, INPUT);
  pinMode(trig_pin, OUTPUT);
}

/* **************************************************************** */

void loop()
{
  for(posit = 0; posit <= 180; posit += 1) {
    myservo.write(posit);
    meter();
    delay(25);
  }

  for(posit = 180; posit >= 0; posit -= 1) {
    myservo.write(posit);
    meter();
    delay(25);
  }
}

/* **************************************************************** */

void meter(){
    distance = metr.ping_cm();      // uloží do proměnné vzdálenost výsledek ping_cm (co měří vzdálenost)
    Serial.println(distance);
    delay(20);
  }