#include <ESP32Servo.h>
#include <WiFi.h>
#include <WiFiClient.h>
#include <BlynkSimpleEsp32.h>

#define BLYNK_TEMPLATE_ID "TMPL6Dwarr5_D"
#define BLYNK_TEMPLATE_NAME "UTS"
#define BLYNK_AUTH_TOKEN "b1CZelQ5GfppAjY7JJQHpbxiWpvOFmXJ"

char auth[] = BLYNK_AUTH_TOKEN;
char ssid[] = "Wokwi-GUEST";
char pass[] = "";

BlynkTimer timer;

#define ECHO_PIN 15
#define TRIG_PIN 2
#define pinBuzzer 25
#define LED 27
#define LED2 14
#define LED3 12

Servo myservo;
int rotasi = 90;
int interval = 0;

bool isAuto = 1;
bool on = 0;

BLYNK_WRITE(V0) {
  int state = param.asInt();
  if(isAuto){
    Blynk.virtualWrite(V0, !state);
  }else{
    Blynk.virtualWrite(V0, state);
    if(!state){
      on = 0;
    }else{
      on = 1;
    }
  }
}

BLYNK_WRITE(V3) {
  int state = param.asInt();
  isAuto = state;
}

void send_data() {
  float jarak = readDistanceCM();
  Blynk.virtualWrite(V1, jarak);
  if (isAuto) Serial.println("auto");
  else Serial.println("Manual");
}

float readDistanceCM(){
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  int duration = pulseIn(ECHO_PIN, HIGH);
  return duration * 0.034 / 2;
}

void soundBuzzer(){
  if(interval < 500){
    tone(pinBuzzer, 350);
    digitalWrite(LED, HIGH);
    digitalWrite(LED2, LOW);
    digitalWrite(LED3, LOW);
  }else
  if(interval > 500){
    tone(pinBuzzer, 300);
    digitalWrite(LED2, HIGH);
    digitalWrite(LED, LOW);
    digitalWrite(LED3, LOW);
  }
}

void setup() {
  // put your setup code here, to run once:
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(LED, OUTPUT);
  pinMode(LED2, OUTPUT);
  pinMode(LED3, OUTPUT);
  Serial.begin(115200);
  pinMode(pinBuzzer, OUTPUT);
  myservo.attach(18);
  myservo.write(90);

  Blynk.begin(auth, ssid, pass, "blynk.cloud", 80);
  timer.setInterval(1000L, send_data);
  Blynk.virtualWrite(V3, isAuto);

}

void loop() {
  // put your main code here, to run repeatedly:

  Blynk.run();
  timer.run();

  tutupPalang();
  interval +=80;
  if(interval>1000) interval = 0;
}

void tutupPalang(){
  float jarak = readDistanceCM();
  if(isAuto){
    if(jarak > 0 && jarak < 100 ){
      soundBuzzer();
      tutup();
    }else{
      buka();
      noTone(pinBuzzer);
    }
  }else{
    if(on){
      soundBuzzer();
      tutup();
    }else{
      buka();
      noTone(pinBuzzer);
    }
  }
}

void tutup(){
  if(rotasi <= 90){
    myservo.write(rotasi);
    delay(100);
    rotasi--;
  }
  if(rotasi <= 0 ) rotasi = 0;
}

void buka(){
  if(rotasi <= 90){
    myservo.write(rotasi);
    delay(100);
    rotasi+=4;
    digitalWrite(LED, LOW);
    digitalWrite(LED2, LOW);
    digitalWrite(LED3, HIGH);
  }
  if(rotasi >= 90 ) rotasi = 90;
}