#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