#include <ESP32Servo.h>

#define PIN_TRIG 4
#define PIN_ECHO 2
#define POT_PIN 12

Servo servo;
const int servoPin = 18;
int piezoPin = 26;
int freq = 440;
int duty = 512;
char estado = 'F';
int ContadorPessoas = 0;

void setup() {
  pinMode(piezoPin, OUTPUT);
  servo.attach(servoPin, 500, 2400);
  Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(POT_PIN, INPUT);
}

 
void soundBuzzer(){  // Função para tocar o buzzer
  tone(piezoPin, freq, duty);
  delay(5);
  noTone(piezoPin);
  delay(5);
}


void servoMotorFechar(){  // Funcao para rotação do servo motor
  soundBuzzer();
  for (int pos = 0; pos <= 90; pos += 1) {
    servo.write(pos);
    delay(15);
  }
  estado = 'F';
}


void servoMotorAbrir(){  // Abri o motor servo
  soundBuzzer();
  for (int pos = 90; pos >= 0; pos -= 1) {
    servo.write(pos);
    delay(15);
  } 
  estado = 'A';
}


void mecanicaPorta(double distancia){    // Mecanismo de fechamento e abertura da porta
  if ((distancia > 5.0) && (distancia < 312.0)){
    Serial.print(sensorSuperSonico());
 
    if ((distancia <= 100) && (estado == 'F')){
        servoMotorAbrir();
        Serial.print(estado);
    }
    else if ((distancia > 100.0) && estado == 'A'){
      servoMotorFechar();
      Serial.print(estado);
    }

  }
  else{
    if(estado == 'F')
      servo.write(90);
    else if (estado == 'A')
      servo.write(0);
  }
}


float sensorSuperSonico(){   // Sensor ultra sonico que calcula e retorna a distancia
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  int duration = pulseIn(PIN_ECHO, HIGH);
  delay(1000);

  return (duration / 58);
}


int potenciometro(){  // Medidor de resistencia que retorna um inteiro 
  int valor = analogRead(POT_PIN);
  delay(10); 
  
  return valor;
}

void loop() {  // Main 
  float distancia = sensorSuperSonico();

  mecanicaPorta(distancia);
  
 // Serial.print(potenciometro());
}