#include <Servo.h>

Servo wings;

void setup() {

// LED-Valot

pinMode(7, OUTPUT);
pinMode(6, OUTPUT);
pinMode(5, OUTPUT);

// Nappulat

pinMode(8, INPUT_PULLUP);
pinMode(9, INPUT_PULLUP);
pinMode(10, INPUT_PULLUP);
pinMode(11, INPUT_PULLUP);


// Servomoottorit "siivet"
wings.attach(3);

}

bool checkButtons() {
  return (digitalRead(8) == 0, digitalRead(9) == 0, digitalRead(10) == 0);
}

void loop() {
  
  int crowded_red = digitalRead(10);
  int there_is_space_green = digitalRead(9);
  int friend_in_area_blue = digitalRead(8);
  int stop_everything = digitalRead(11);

  if (crowded_red == 0) {
    digitalWrite(7, HIGH);
    digitalWrite(6, LOW);
    digitalWrite(5, LOW);
    wings.write(90);
  }

  else if (there_is_space_green == 0) {
    digitalWrite(6, HIGH);
    digitalWrite(7, LOW);
    digitalWrite(5, LOW);
    wings.write(0);
  } 

  else if (friend_in_area_blue == 0) {
    digitalWrite(7, LOW);
    digitalWrite(6, LOW);
    digitalWrite(5, HIGH);

    while (friend_in_area_blue == 1);

      wings.write(0);
      delay(1000);
      wings.write(90);
      delay(1000);
    
  }

  else if (stop_everything == 0) {
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    digitalWrite(7, LOW);
    wings.write(90);
  }
}