#include <Servo.h>

Servo myservo;
int led1 = 6;
int led2 = 5;
int pot1 = 0;
int pot2 = 0;
int MapPot1 = 0;
int MapPot2 = 0;
int sudut = 0;

void setup() {
  myservo.attach(9);
  pinMode(led1, OUTPUT);
  pinMode(led2, OUTPUT);
  myservo.write(90);
  Serial.begin(115200);
}

void mati(){
  if (MapPot1 == MapPot2) {
    digitalWrite(led1, LOW);
    digitalWrite(led2, LOW);
    Serial.print("LED Mati, Sudut Servo: "  + String(sudut));
    Serial.println("°");
  }
}

void loop() {
  pot1 = analogRead(A1); //potensio 1
  pot2 = analogRead(A0); //potensio 2
  MapPot1 = map(pot1, 0, 1023, 0, 90);
  MapPot2 = map(pot2, 0, 1023, 0, 90);
  int sudut = ((MapPot1 - MapPot2) + 90);
  if (MapPot1 > MapPot2) {
    digitalWrite(led1, HIGH);
    digitalWrite(led2, LOW);
    Serial.print("LED 1 Hidup, Sudut Servo: "  + String(sudut));
    Serial.println("°");
  } else if (MapPot1 < MapPot2) {
    digitalWrite(led1, LOW);
    digitalWrite(led2, HIGH);
    Serial.print("LED 2 Hidup, Sudut Servo: "  + String(sudut));
    Serial.println("°"); 
  }

  mati(); 
  myservo.write(sudut);
  delay(400);
}