#include <ESP32Servo.h>
int servopin  = 4;
int servopin2 =5;

int trigpin = 16;
int echopin = 15;
Servo servo1;
Servo servo2;
int nomor_absen = 28;
float waktu, jarak;


void setup() {
Serial.begin(115200);
servo1.attach(servopin);
servo2.attach(servopin2);
pinMode(trigpin, OUTPUT);
pinMode(echopin, INPUT);

}

void loop() {
  digitalWrite(trigpin, HIGH);
  delay(10);
  digitalWrite(trigpin, LOW);
  waktu = pulseIn(echopin, HIGH);
  jarak = 0.017 * waktu;
  
  if(jarak <= nomor_absen + 5) {
    servo1.write(180);
    servo2.write(0);
    //Serial.println("servo1 -> 180 degree");
  }
  //maksud miss kata sampai -> && (AND)
  else if(jarak > nomor_absen + 5 && jarak < nomor_absen +20) {
     servo1.write(0);
     servo2.write(180);
     // Serial.println("servo2 -> 180 degree");
  }
  else {
    servo1.write(0);
    servo2.write(0);
     //Serial.println("servo1 nor servo2 ->  0 degree");
  }
 
}