#include <ESP32Servo.h>
Servo servo;
int trig = 18, echo = 5 ;
int pos = 0, distcm = 0;
void setup()
{
Serial.begin(9600);
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
servo.attach(2);
}
void loop()
{
for (pos = 0; pos <= 180; pos += 1)
{
servo.write(pos);
delay(50);
Serial.println(radar());
}
for (pos = 180; pos >= 0; pos -= 1)
{
servo.write(pos);
delay(50);
Serial.println(radar());
}
}
long radar(void)
{
digitalWrite(trig, HIGH);
delayMicroseconds(15);
digitalWrite(trig, LOW);
long dur = pulseIn(echo, HIGH);
distcm = dur / 58;
return distcm;
}