#include <Servo.h>
//Fahreza Ananda_2105106010046

// Deklarasi objek servo
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;
Servo servo6;

void setup() {
  // Menghubungkan servo dengan pin Arduino
  servo1.attach(3);
  servo2.attach(5);
  servo3.attach(6);
  servo4.attach(9);
  servo5.attach(10);
  servo6.attach(11);
}

void loop() {
  // Step 1: Semua servo bergerak ke tengah (90 derajat)
  servo1.write(90);
  servo2.write(90);
  servo3.write(90);
  servo4.write(90);
  servo5.write(90);
  servo6.write(90);
  delay(500);

  // Step 2: Servo 3 dan 4 bergerak berlawanan arah
  servo3.write(0);
  servo4.write(180);
  delay(500);
  
  // Step 3: Servo 2 dan 5 bergerak berlawanan arah
  servo2.write(0);
  servo5.write(180);
  delay(300);
  
  // Step 4: Servo 1 dan 6 bergerak berlawanan arah
  servo1.write(0);
  servo6.write(180);
  delay(300);

  // Step 5: Semua servo kembali ke posisi tengah
  servo1.write(90);
  servo2.write(90);
  servo3.write(90);
  servo4.write(90);
  servo5.write(90);
  servo6.write(90);
  delay(500);

  // Step 6: Semua servo bergerak serentak ke 180 derajat
  servo1.write(180);
  servo2.write(180);
  servo3.write(180);
  servo4.write(0);
  servo5.write(0);
  servo6.write(0);
  delay(500);

  // Step 7: Servo bergerak dengan pola wave
  for (int i = 0; i < 3; i++) { 
    servo1.write(0);
    delay(100);
    servo2.write(0);
    delay(100);
    servo3.write(0);
    delay(100);
    servo4.write(180);
    delay(100);
    servo5.write(180);
    delay(100);
    servo6.write(180);
    delay(100);
  }
  
  // Step 8: Semua servo kembali ke posisi semula
  servo1.write(90);
  servo2.write(90);
  servo3.write(90);
  servo4.write(90);
  servo5.write(90);
  servo6.write(90);
  delay(1000); 
}