#include <Servo.h>

Servo servos[6];  // Membuat array objek servo untuk 6 servo
const int servoPins[] = {2, 3, 4, 5, 6, 7};  // Pin yang terhubung ke servo (sesuaikan dengan pengaturan perangkat keras Anda)

const int minAngle = 0;  // Sudut minimum
const int maxAngle = 180;  // Sudut maksimum
const int stepSize = 2;  // Ukuran langkah pergerakan servo

void setup() {
  // Menghubungkan setiap servo ke pin yang ditentukan
  for (int i = 0; i < 6; i++) {
    servos[i].attach(servoPins[i]);
  }
}

void loop() {
  // Menggerakkan setiap servo dari sudut minimum ke maksimum
  for (int angle = minAngle; angle <= maxAngle; angle += stepSize) {
    for (int i = 0; i < 6; i++) {
      servos[i].write(angle);  // Mengatur sudut servo
      delay(15);  // Delay untuk gerakan yang lebih halus
    }
  }

  delay(1000);  // Delay sebelum kembali

  // Menggerakkan setiap servo dari sudut maksimum ke minimum
  for (int angle = maxAngle; angle >= minAngle; angle -= stepSize) {
    for (int i = 0; i < 6; i++) {
      servos[i].write(angle);  // Mengatur sudut servo
      delay(15);  // Delay untuk gerakan yang lebih halus
    }
  }

  delay(1000);  // Delay sebelum kembali
}