#define BLYNK_PRINT Serial
#define BLYNK_TEMPLATE_ID "TMPL3f3cIIv-s"
#define BLYNK_TEMPLATE_NAME "Servo and USS"
#define BLYNK_AUTH_TOKEN "HELzptJ-w9oeDQLOZct8NLikZSYQKG4V"
#include <ESP32Servo.h>
#include <WiFi.h>
#include <WiFiClient.h>
#include <BlynkSimpleEsp32.h>
Servo servo;

long duration;
int distance;
const int trig = 23;
const int echo = 22;

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


BLYNK_WRITE (V0)
{
SERVOANGLE = param.asInt();
servo.write(SERVOANGLE);
Blynk.virtualWrite(V1, distance);
}

BLYNK_WRITE (V1)
{
Blynk.virtualWrite(V1, distance);
}

void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  servo.attach(25);
  Blynk.begin(auth, ssid, pass);
}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);

  duration = pulseIn(echo, HIGH);
  distance = (0.034 *  duration)/2;
  
  // Serial.println(distance);
  Blynk.run();
}