#include <Servo.h>

// Pin definitions
const int SERVO_PIN = 9;
const int LED_PIN = 10;
const int BTN1_PIN = 11;
const int BTN2_PIN = 12;

// State variables
Servo servo1;
int currentAngle = 90;
int targetAngle = 90;
bool isMoving = false;
unsigned long movementStartTime = 0;
const unsigned long MIN_LED_DURATION = 2000; // 2 seconds

// Button debounce variables
bool btn1PrevState = HIGH;
bool btn2PrevState = HIGH;
unsigned long lastDebounceTime1 = 0;
unsigned long lastDebounceTime2 = 0;
const unsigned long debounceDelay = 150; // 0.15 seconds

void setup() {
  // Initialize servo
  servo1.attach(SERVO_PIN);
  servo1.write(currentAngle);
  
  // Initialize LED
  pinMode(LED_PIN, OUTPUT);
  digitalWrite(LED_PIN, LOW);
  
  // Initialize buttons with internal pull-up resistors
  pinMode(BTN1_PIN, INPUT_PULLUP);
  pinMode(BTN2_PIN, INPUT_PULLUP);
}

void loop() {
  // Read button states (LOW when pressed, HIGH when not pressed)
  bool btn1State = digitalRead(BTN1_PIN);
  bool btn2State = digitalRead(BTN2_PIN);
  
  // Handle button1 press with debounce
  if (btn1State != btn1PrevState) {
    lastDebounceTime1 = millis();
  }
  
  if ((millis() - lastDebounceTime1) > debounceDelay) {
    if (btn1State == LOW && btn1PrevState == HIGH && !isMoving) {
      // Button 1 is pressed and wasn't previously pressed, and servo is not already moving
      if (currentAngle < 180) {
        targetAngle = currentAngle + 30;
        if (targetAngle > 180) targetAngle = 180;
        
        isMoving = true;
        movementStartTime = millis();
        digitalWrite(LED_PIN, HIGH);
      }
    }
  }
  
  // Handle button2 press with debounce
  if (btn2State != btn2PrevState) {
    lastDebounceTime2 = millis();
  }
  
  if ((millis() - lastDebounceTime2) > debounceDelay) {
    if (btn2State == LOW && btn2PrevState == HIGH && !isMoving) {
      // Button 2 is pressed and wasn't previously pressed, and servo is not already moving
      if (currentAngle > 0) {
        targetAngle = currentAngle - 30;
        if (targetAngle < 0) targetAngle = 0;
        
        isMoving = true;
        movementStartTime = millis();
        digitalWrite(LED_PIN, HIGH);
      }
    }
  }
  
  // Move servo gradually if it's in motion
  if (isMoving) {
    if (currentAngle < targetAngle) {
      currentAngle++;
      servo1.write(currentAngle);
      delay(10); // Slow down the movement
    } else if (currentAngle > targetAngle) {
      currentAngle--;
      servo1.write(currentAngle);
      delay(10); // Slow down the movement
    } else {
      // Servo has reached the target angle
      // Check if at least 2 seconds have passed since the start of movement
      if (millis() - movementStartTime >= MIN_LED_DURATION) {
        isMoving = false;
        digitalWrite(LED_PIN, LOW);
      }
    }
  }
  
  // Update previous button states
  btn1PrevState = btn1State;
  btn2PrevState = btn2State;
}
mega:SCL
mega:SDA
mega:AREF
mega:GND.1
mega:13
mega:12
mega:11
mega:10
mega:9
mega:8
mega:7
mega:6
mega:5
mega:4
mega:3
mega:2
mega:1
mega:0
mega:14
mega:15
mega:16
mega:17
mega:18
mega:19
mega:20
mega:21
mega:5V.1
mega:5V.2
mega:22
mega:23
mega:24
mega:25
mega:26
mega:27
mega:28
mega:29
mega:30
mega:31
mega:32
mega:33
mega:34
mega:35
mega:36
mega:37
mega:38
mega:39
mega:40
mega:41
mega:42
mega:43
mega:44
mega:45
mega:46
mega:47
mega:48
mega:49
mega:50
mega:51
mega:52
mega:53
mega:GND.4
mega:GND.5
mega:IOREF
mega:RESET
mega:3.3V
mega:5V
mega:GND.2
mega:GND.3
mega:VIN
mega:A0
mega:A1
mega:A2
mega:A3
mega:A4
mega:A5
mega:A6
mega:A7
mega:A8
mega:A9
mega:A10
mega:A11
mega:A12
mega:A13
mega:A14
mega:A15
led1:A
led1:C
btn1:1.l
btn1:2.l
btn1:1.r
btn1:2.r
btn2:1.l
btn2:2.l
btn2:1.r
btn2:2.r
servo1:GND
servo1:V+
servo1:PWM