#include<ESP32Servo.h>

#define  trig_pin 22
#define  echo 23
#define  servo_pin 26
#define  batas 100

Servo servo;

float jarak,durasi;

void setup() {
  Serial.begin(9600);
  pinMode(22, OUTPUT);
  pinMode(23, INPUT);
  servo.attach(26);
  servo.write(0);

}

void loop() {
  digitalWrite(22, HIGH);
  delayMicroseconds(10);
  digitalWrite(22, LOW);

  durasi=pulseIn(23, HIGH);
  jarak = 0.017 * durasi;

if (jarak < batas)
  servo.write(90);
else
  servo.write(0);

Serial.print("Jarak = ");
Serial.println(jarak);
Serial.print("cm");
delay(500);


}