#define  ECHO_PIN 18
#define  TRIG_PIN 5
#define pinBuzzer 19
#define led_y 2

//#include <Servo.h>
#include <ESP32Servo.h>

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

float jarak = 0;

#include <WiFi.h>
#include <WiFiClient.h>
#include <BlynkSimpleEsp32.h>
WidgetLED LED_Yellow(V2);
BlynkTimer timer;

#define BLYNK_TEMPLATE_ID "TMPL6UDBzdBxL"
#define BLYNK_TEMPLATE_NAME "MDL4Copy"
#define BLYNK_AUTH_TOKEN "R5R6oCPydYGpcYhm6IHTqip67e4ovNbF"

#define BLYNK_PRINT Serial

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


BLYNK_WRITE(V4){
  if(param.asInt() > 0){
    digitalWrite(led_y, HIGH);
    LED_Yellow.on();
  }
  else{
    digitalWrite(led_y, LOW);
    LED_Yellow.off();
  }
}

BLYNK_WRITE(V6){

  nilainada = param.asInt();

}


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, 250);
  }else
  if(interval > 500){
    tone(pinBuzzer, 100,800);
  };
}

void setup() {
  // put your setup code here, to run once:
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(led_y, OUTPUT);
  Serial.begin(115200);
  pinMode(pinBuzzer, OUTPUT);
  Blynk.begin(auth, ssid, pass);

  timer.setInterval(3L, send_data);
  myservo.attach(13);
  myservo.write(90);
}

void send_data() {
  // put your main code here, to run repeatedly:
 jarak = readDistanceCM();
 //float sBuzzer = soundBuzzer();
// tutupPalang();
 interval +=100;
 if(interval>1000) interval = 0;
 Serial.print("Distance (cm): ");
 Serial.println(jarak);
 Blynk.virtualWrite(V3, jarak);
 Blynk.virtualWrite(V5, nilainada);
 //tone(pinBuzzer,nilainada);

  if(jarak > 0 && jarak < 100 ){
    //soundBuzzer();

    tone(pinBuzzer,nilainada);
    digitalWrite(led_y, HIGH);
    LED_Yellow.on();
    tutup();
  }else{
    buka();
    digitalWrite(led_y, LOW);
    LED_Yellow.off();
    noTone(pinBuzzer);
  }
 
}

//void tutupPalang(){
  //jarak = readDistanceCM();
 
//}

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;
  }
  if(rotasi >= 90 ) rotasi = 90;
}

void loop(){
   Blynk.run();
   timer.run();
}