#include <Servo.h>
Servo myservo;
const int buttonPin1 = 2;
const int buttonPin2 = 3;
boolean button1_SET = false;
boolean button2_SET = false;
void setup() {
pinMode(buttonPin1, INPUT);
pinMode(buttonPin2, INPUT);
myservo.attach(6);
Serial.begin(115200);
Serial.println("RUNNING");
myservo.write(0); // start pozicia
}
void loop() {
if(!button1_SET){
int reading1 = digitalRead(buttonPin1);
if(reading1){
Serial.println("BUTTON 1 ENGAGED");
button1_SET = true;
myservo.write(90);
}
}
if(!button2_SET){
int reading2 = digitalRead(buttonPin2);
if(reading2){
Serial.println("BUTTON 2 ENGAGED");
button2_SET = true;
myservo.write(90);
}
}
if(button1_SET && button2_SET){
Serial.println("RESETTING");
myservo.write(0);
button1_SET = false;
button2_SET = false;
}
}Kliknutím na tlačidlo sa imituje pulz z IR snímača prekážky pri detekcii rušňa.