//Aula: Conectando Sensor Ultrassonico HC-SR04 ao Arduino
//Autor: Eduardo Larrubia

//Carrega a biblioteca do sensor ultrassonico
#include <Ultrasonic.h>
#include <Servo.h>

//Define os pinos para o trigger e echo
#define pino_trigger 8
#define pino_echo 7

Servo myservo;

int pos = 0;


//Inicializa o sensor nos pinos definidos acima
Ultrasonic ultrasonic(pino_trigger, pino_echo);

void setup()
{
  Serial.begin(9600);
  Serial.println("Lendo dados do sensor...");
  pinMode(11, OUTPUT);
  myservo.attach(4);
  float limite;
  limite = 50;
}

void loop()
{
  //Le as informacoes do sensor, em cm e pol
  float limite;
  limite = 50;
  float cmMsec, inMsec;
  long microsec = ultrasonic.timing();
  cmMsec = ultrasonic.convert(microsec, Ultrasonic::CM);
  inMsec = ultrasonic.convert(microsec, Ultrasonic::IN);
  //Exibe informacoes no serial monitor
  Serial.print("Distancia em cm: ");
  Serial.print(cmMsec);
  Serial.print(" - Distancia em polegadas: ");
  Serial.println(inMsec);
  delay(1000);
   if (cmMsec < limite)
   {
    Serial.println("detectado ");
    abre();

   }
   else
  {
    Serial.println("não detectado ");
    fecha();
  }

}

void abre()
{
  digitalWrite(11, HIGH);
  myservo.write(0);
}

void fecha()
{
    digitalWrite(11, LOW);
    myservo.write(180);
}