#include <ESP32Servo.h>
#define BLYNK_TEMPLATE_ID "TMPL6W1ZIOL1b"
#define BLYNK_TEMPLATE_NAME "TES 30"
#define BLYNK_AUTH_TOKEN "YkLz-Fv6L7_TpP6KwV82Zb5jHWmrGm-K"
#define BLYNK_PRINT Serial



#define TRIG_PIN  23  // ESP32 pin GIOP23 connected to Ultrasonic Sensor's TRIG pin
#define ECHO_PIN  22  // ESP32 pin GIOP22 connected to Ultrasonic Sensor's ECHO pin
#define SERVO_PIN 26  // ESP32 pin GIOP26 connected to Servo Motor's pin
#define DISTANCE_THRESHOLD  170 // centimeters

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

// Your WiFi credentials.
// Set password to "" for open networks.

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

BlynkTimer timer;

Servo servo; // create servo object to control a servo

// variables will change:
float duration_us, distance_cm;


BLYNK_WRITE(V2)
{
  int pinValue = param.asInt(); // assigning incoming value from pin V1 to a variable
  if (pinValue==1){servo.write(90);} else{servo.write(0); }
}


void setup() {
  Serial.begin (115200);       // initialize serial port
  pinMode(TRIG_PIN, OUTPUT); // set ESP32 pin to output mode
  pinMode(ECHO_PIN, INPUT);  // set ESP32 pin to input mode
  servo.attach(SERVO_PIN);   // attaches the servo on pin 9 to the servo object
  servo.write(0);
  Blynk.begin(BLYNK_AUTH_TOKEN, ssid, pass);
  Serial.begin(115200);
}

void loop() {
  // generate 10-microsecond pulse to TRIG pin
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

  // measure duration of pulse from ECHO pin
  duration_us = pulseIn(ECHO_PIN, HIGH);
  // calculate the distance
  distance_cm = 0.017 * duration_us;

  if (distance_cm < 100)
    servo.write(0); // rotate servo motor to 90 degree
  if (distance_cm > 170)
    servo.write(180);  // rotate servo motor to 0 degree


  // print the value to Serial Monitor
  Serial.print("distance: ");
  Serial.print(distance_cm);
  Serial.println(" cm");

  delay(500);
  Blynk.run();
}