#include <ESP32Servo.h>
bool
const int servoPin = 12;
Servo servo;
const int echo_pin=27,trig_pin=2;
#define led 19
void setup()
{
servo.attach(servoPin, 500, 2400);
pinMode(echo_pin, INPUT);
pinMode(trig_pin,OUTPUT);
pinMode(led, OUTPUT);
//clear the trigger
digitalWrite(trig_pin,LOW);
delayMicroseconds(2);
Serial.begin(115200);
}
void loop()
{
digitalWrite(trig_pin,HIGH);
delayMicroseconds(10);
digitalWrite(trig_pin, LOW);
//read the length of HIGH pulse in microseconds
long duration=pulseIn(echo_pin,HIGH);
//Serial.println("Distance in cm:");
//Serial.println(duration/58);
delay(100);
if(duration/58 <= 200)
{
digitalWrite(led, HIGH);
servo.write(90);
/*delay(250);
servo.write(0);
delay(250);
servo.write(90);
delay(250);
servo.write(0);
delay(500);*/
}
else
{
digitalWrite(led, LOW);
servo.write(0);
}
}