#include <Servo.h>

Servo Servoku;

int Lampu1 = PA11;
int Lampu2 = PA12;
int Lampu3 = PA15;
int Lampu4 = PB3;
int Lampu5 = PB4;

int PinTom1 = PA1;
int PinTom2 = PA2;

int ValTom1 = 0;
int ValTom2 = 0;
int ValPot = 0;

int stop1 = 0;
int stop2 = 0;

int Var = 0;
int Derajat = 0;

void setup() {
  pinMode(Lampu1, OUTPUT);
  pinMode(Lampu2, OUTPUT);
  pinMode(Lampu3, OUTPUT);
  pinMode(Lampu4, OUTPUT);
  pinMode(Lampu5, OUTPUT);

  pinMode(PinTom1, INPUT_PULLUP);
  pinMode(PinTom2, INPUT_PULLUP);

  Servoku.attach(PA9);

  digitalWrite(Lampu1, LOW);
  digitalWrite(Lampu2, LOW);
  digitalWrite(Lampu3, LOW);
  digitalWrite(Lampu4, LOW);
  // digitalWrite(Lampu5, LOW);
}

void loop() {
  ValTom1 = digitalRead(PinTom1);
  ValTom2 = digitalRead(PinTom2);
  ValPot = analogRead(PA0);

  Var = map(ValPot, 0, 1023, 0, 5);        // Untuk LED
  Derajat = map(ValPot, 0, 1023, 0, 180);  // Untuk Servo

  Servoku.write(Derajat);

  analogWrite(Lampu5, Derajat);

  switch (Var) {
    case 1:
      digitalWrite(Lampu1, HIGH);
      digitalWrite(Lampu2, HIGH);
      digitalWrite(Lampu3, HIGH);
      digitalWrite(Lampu4, LOW);
      // digitalWrite(Lampu5, LOW);
      break;
    case 2:
      digitalWrite(Lampu1, LOW);
      digitalWrite(Lampu2, HIGH);
      digitalWrite(Lampu3, HIGH);
      digitalWrite(Lampu4, LOW);
      // digitalWrite(Lampu5, LOW);
      break;
    case 3:
      digitalWrite(Lampu1, LOW);
      digitalWrite(Lampu2, LOW);
      digitalWrite(Lampu3, HIGH);
      digitalWrite(Lampu4, LOW);
      // digitalWrite(Lampu5, LOW);
      break;
    case 4:
      digitalWrite(Lampu1, LOW);
      digitalWrite(Lampu2, LOW);
      digitalWrite(Lampu3, HIGH);
      digitalWrite(Lampu4, HIGH);
      // digitalWrite(Lampu5, LOW);
      break;
    case 5:
      digitalWrite(Lampu1, LOW);
      digitalWrite(Lampu2, LOW);
      digitalWrite(Lampu3, HIGH);
      digitalWrite(Lampu4, HIGH);
      // digitalWrite(Lampu5, HIGH);
      break;
    default:
      break;
  }
  delay(1);
}