#include <Servo.h>

// Inisialisasi servo
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;

// Pin untuk servo
int servo1Pin = 9;
int servo2Pin = 10;
int servo3Pin = 11;
int servo4Pin = 12;

// Pin analog untuk potensiometer
int pot1Pin = A0;
int pot2Pin = A1;
int pot3Pin = A2;
int pot4Pin = A3;

int val1, val2, val3, val4;

void setup() {
  // Menghubungkan servo ke pin Arduino
  servo1.attach(servo1Pin);
  servo2.attach(servo2Pin);
  servo3.attach(servo3Pin);
  servo4.attach(servo4Pin);

  // Mulai komunikasi serial untuk debugging (jika diperlukan)
  Serial.begin(9600);
}

void loop() {
  // Membaca nilai dari potensiometer
  val1 = analogRead(pot1Pin);  // Membaca potensiometer 1
  val2 = analogRead(pot2Pin);  // Membaca potensiometer 2
  val3 = analogRead(pot3Pin);  // Membaca potensiometer 3
  val4 = analogRead(pot4Pin);  // Membaca potensiometer 4
  
  // Mengubah nilai analog (0-1023) menjadi sudut servo (0-180 derajat)
  int angle1 = map(val1, 0, 1023, 0, 180);
  int angle2 = map(val2, 0, 1023, 0, 180);
  int angle3 = map(val3, 0, 1023, 0, 180);
  int angle4 = map(val4, 0, 1023, 0, 180);
  
  // Menyinkronkan posisi servo dengan nilai potensiometer
  servo1.write(angle1);
  servo2.write(angle2);
  servo3.write(angle3);
  servo4.write(angle4);

  // Debugging (Opsional)
  Serial.print("Pot 1: ");
  Serial.print(val1);
  Serial.print(" -> Angle 1: ");
  Serial.println(angle1);

  Serial.print("Pot 2: ");
  Serial.print(val2);
  Serial.print(" -> Angle 2: ");
  Serial.println(angle2);

  Serial.print("Pot 3: ");
  Serial.print(val3);
  Serial.print(" -> Angle 3: ");
  Serial.println(angle3);

  Serial.print("Pot 4: ");
  Serial.print(val4);
  Serial.print(" -> Angle 4: ");
  Serial.println(angle4);

  // Delay untuk stabilitas pembacaan
  delay(50);
}