#include <ESP32Servo.h>

Servo myservo[5]; // Array untuk menyimpan objek Servo
int pos = 0;
int servoPins[] = {23, 22, 19, 2, 13}; // Pin servo yang digunakan
int potPin = A0; // Pin A0 pada ESP32

void setup() {
  Serial.begin(115200);
  Serial.println("WELCOME");

  // Melakukan attach semua servo ke pin masing-masing
  for (int i = 0; i < 5; i++) {
    myservo[i].attach(servoPins[i]);
  }
}

void loop() {
  int potValue = analogRead(potPin); // Baca nilai potensiometer
  int angle = map(potValue, 0, 4095, 0, 180); // Ubah nilai potensiometer menjadi sudut (0-180 derajat)

  // Menggerakkan semua servo dengan sudut yang sama
  for (int i = 0; i < 5; i++) {
    myservo[i].write(angle);
    delay(500); //memberikan delay selama n untuk setiao pergerakan servo
  }
  
  delay(15);
  
  // Output ke serial monitor untuk memantau posisi servo
  Serial.print("Posisi --> ");
  Serial.print(angle);
  Serial.println("°");
}