#include <ESP32Servo.h>
Servo servo;
void setup() {
Serial.begin(115200);
servo.attach(13);
pinMode(4, INPUT);
pinMode(15, OUTPUT);
}
void loop() {
// Start a new measurement:
digitalWrite(15, HIGH);
delayMicroseconds(10);
digitalWrite(15, LOW);
// Read the result:
int d = pulseIn(4, HIGH);
Serial.print("Distance in CM: ");
Serial.println(d / 58);
delay(1000);
int cm = d / 58;
if (cm <= 200) {
servo.write(180);
delay(3000);
} else {
servo.write(0);
delay(1000);
}
} //////////// END LOOP