#include <Servo.h>
#include <Ultrasonic.h>
//#include <Stepper.h>

// Define os pinos
#define pin_trig 3
#define pin_echo 5

int distancia = 0;
int cont = 0; 
const int valorDist = 6;
bool state = false;

Ultrasonic sensor(pin_trig, pin_echo); // Cria o sensor

Servo servo; // Cria um objeto servo

// initialize the stepper library on pins 8 through 11:


void setup() {
  servo.attach(6, 500, 2500); // Inicia o servo no pino 6 com 500ms para 0º e 2500 para 180º
  servo.write(0);
  Serial.begin(9600);
}

void loop() {
  distancia = 0;
  for(int i=0;i<=2;i++){
  distancia += sensor.read();
  delay(10);
  }
  
  cont = (distancia/3);

  if (cont < valorDist && state == false) {
      servo.write(120);
      state = !state;
      delay(1000);
      servo.write(0);
  }
  if(cont > valorDist){
    state = false;
  }
    Serial.println(cont);
  delay(200); // Espera um quarto de segundo antes de ler novamente
}