#include <ESP32Servo.h>

const int trigPin = 27;
const int echoPin = 26;
const int ledPin = 18;
const int servoPin = 14;
const int servoPin2 = 12;


long duration;
int distance;
Servo myServo;
Servo myServo2;

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(ledPin, OUTPUT);
  myServo.attach(servoPin);
  myServo2.attach(servoPin2);
  Serial.begin(9600);
}

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

  duration = pulseIn(echoPin, HIGH);

  distance = duration * 0.034 / 2;

  Serial.println("jarak: ");
  Serial.println(distance);
  Serial.println(" cm");

  if (distance < 10) {
    digitalWrite(ledPin, HIGH);
    myServo.write(90);
  } else {
    digitalWrite(ledPin, LOW);
    myServo.write(0);
  } if (distance < 10) {
    digitalWrite(ledPin, HIGH);
    myServo2.write(0);
  } else {
    digitalWrite(ledPin, LOW);
    myServo2.write(90);
  }
  delay(500);
}