#include <Servo.h>

Servo myservo1;
Servo myservo2;

int jet = 2;

int servo1 = 3;
int servo2 = 4;

int servo1_sw = 5;
int servo2_sw = 6;

int servo1_sw_state = HIGH;
int servo2_sw_state = HIGH;

int prev_jet_state = LOW;

void setup() {
  Serial.begin(9600);
  pinMode(jet, INPUT);
  myservo1.attach(servo1);
  myservo2.attach(servo2);

  pinMode(servo1_sw, INPUT);
  pinMode(servo2_sw, INPUT);

  // Szervók beállítása 0°-ra
  myservo1.write(0);
  myservo2.write(0);
  Serial.println("Szervók 0°-ra állítva a Setup-ban");
}

void loop() {
  int current_jet_state = digitalRead(jet);
  servo1_sw_state = digitalRead(servo1_sw);
  servo2_sw_state = digitalRead(servo2_sw);

  if (current_jet_state == LOW && prev_jet_state == HIGH && servo2_sw_state == LOW && servo1_sw_state == HIGH) {
    myservo1.write(0);
    delay(700);
    myservo2.write(0);
    Serial.println("Szervók 0°-on álnak");
  } else if (current_jet_state == HIGH && prev_jet_state == LOW && servo2_sw_state == HIGH && servo1_sw_state == LOW) {
    myservo1.write(90);
    delay(700);
    myservo2.write(90);
    Serial.println("Szervók 90°-on álnak");
  }
  prev_jet_state = current_jet_state;
}