#include <ESP32Servo.h> //pemanggilan library motor servo
Servo servo1; //penambahan variable servo1 menggunakan library
Servo servo2; // penambahan variable servo2
#define relay1 22 //mendefinisikan relay 1 
#define relay2 21 //mendefinisikan relay 2

int pos1 = 0; //variable posisi servo 1
int pos2 = 0; //variable posisi servo 2


void setup() {
  Serial.begin(9600);
  // put your setup code here, to run once:
  pinMode(relay1, OUTPUT);
  pinMode(relay2, OUTPUT);
  servo1.attach(4); //konfigurasi pin servo pda pin 4
  servo1.write(0); //derajat posisi putaran motor servo di 0 derajat
  servo2.attach(2);
  servo2.write(0);
}

void loop() {
  // put your main code here, to run repeatedly:
  delay(3000);
  digitalWrite(relay1, HIGH);
  delay(2000);
  digitalWrite(relay2, HIGH);
  delay(1000);
  for (pos1 = 0; pos1 <= 180; pos1 += 10) {
    servo1.write(pos1);
    delay(1000);
    Serial.print("Posisi Servo 1 : ");
    Serial.println(pos1);
    if (pos1 == 180) {
      digitalWrite(relay1, LOW);
      Serial.print("Relay 1 Mati");
    }
  }

  for(pos2 = 0; pos2 <=90; pos2+= 5) {
    servo2.write(pos2);
    delay(1000);
    Serial.print("Posisi Servo 2 : ");
    Serial.println(pos2);
    if (pos2 == 90) {
      digitalWrite(relay2, LOW);
      Serial.print("Relay 2 Mati");
    }
  }
}