#include <Wire.h> 
#include <LiquidCrystal_I2C.h>
#include <Servo.h>

// Inisialisasi LCD menggunakan modul I2C, alamat default 0x27
LiquidCrystal_I2C lcd(0x27, 16, 2);

Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;

int potPin1 = A0; // Pin potensiometer 1
int potPin2 = A1; // Pin potensiometer 2
int potPin3 = A2; // Pin potensiometer 3
int potPin4 = A3; // Pin potensiometer 4

void setup() {
  // Inisialisasi servo motor
  servo1.attach(11);
  servo2.attach(10);
  servo3.attach(9);
  servo4.attach(6);

  // Inisialisasi LCD
  lcd.init();
  lcd.backlight();
}

void loop() {
  int angle1 = map(analogRead(potPin1), 0, 1023, 0, 180);
  int angle2 = map(analogRead(potPin2), 0, 1023, 0, 180);
  int angle3 = map(analogRead(potPin3), 0, 1023, 0, 180);
  int angle4 = map(analogRead(potPin4), 0, 1023, 0, 180);

  servo1.write(angle1);
  servo2.write(angle2);
  servo3.write(angle3);
  servo4.write(angle4);

  lcd.setCursor(0, 0);
  lcd.print("S1: ");
  lcd.print(angle1);
  lcd.print("  ");

  lcd.setCursor(0, 1);
  lcd.print("S2: ");
  lcd.print(angle2);
  lcd.print("  ");

  lcd.setCursor(8, 0);
  lcd.print("S3: ");
  lcd.print(angle3);
  lcd.print("  ");

  lcd.setCursor(8, 1);
  lcd.print("S4: ");
  lcd.print(angle4);
  lcd.print("  ");
  delay(100); // Delay untuk memperbarui tampilan
}