#include <Servo.h>
int buttonState = 0;
int lastButtonState = HIGH;
bool buttonPress;
const int buttonPin = 2;
const int ledPin1 = 13;
const int ledPin2 = 12;
int angle = 90;
int serialFlag = 0;
Servo myServo;
void setup() {
pinMode(ledPin1, OUTPUT); // led
pinMode(ledPin2, OUTPUT); // led
pinMode(buttonPin, INPUT_PULLUP);
myServo.attach(9);
Serial.begin(9600); // initialize serial
}
void loop() {
buttonState = digitalRead(buttonPin); // Read button state
if (buttonState == HIGH) {
if (buttonPress) {
// Button was released
angle = 90;
digitalWrite(ledPin1, LOW);
digitalWrite(ledPin2, LOW);
buttonPress = 0;
}
} else {
// if (!buttonPress) {
// Button was pressed
angle = 180;
digitalWrite(ledPin1, HIGH);
digitalWrite(ledPin2, HIGH);
buttonPress = 1;
//}
}
//Serial.print("buttonState: ");
//Serial.println(buttonState);
//Serial.print("buttonPress: ");
//Serial.println(buttonPress);
myServo.write(angle);
delay(1000); // debounce delay
}