#include <ESP32Servo.h>
Servo servo1;

#define ledBiru 25
#define ledMerah 12
#define pinTombol 34

int counterTombol;
bool lastStateButton = HIGH;

void setup()
{
  Serial.begin(115200);
  pinMode(ledBiru, OUTPUT);
  pinMode(ledMerah, OUTPUT);
  pinMode(pinTombol, INPUT_PULLUP);
  servo1.attach(13);
}

void loop()
{
  bool statusTombol = digitalRead(pinTombol);
  if (statusTombol == 0 && lastStateButton == HIGH)
  {
    counterTombol++;
    delay (200);
  }
  lastStateButton = statusTombol;

  Serial.println(counterTombol);

  if (counterTombol == 0)
  {
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledBiru, LOW);
    servo1.write(0);
  }

  else if (counterTombol == 1)
  {
    digitalWrite(ledMerah, HIGH);
    digitalWrite(ledBiru, LOW);
    servo1.write(90);
  }

  else if (counterTombol == 2)
  {
    digitalWrite(ledMerah, HIGH);
    digitalWrite(ledBiru, HIGH);
    servo1.write(180);
  }

  if (counterTombol > 2)
  {
    counterTombol = 0;
  }


}