//2,3,4,5 napit
//6,7,8,9 kerroksen ledit
//11, 12 rele (moottoriALA, moottoriYLA)
//42 alaraja, 44 yläraja, 46, 48, 50, 52 kerros rajoja
int hissiKerros = 2;
int tilattuKerros = 2;
int palavaLedi;
int apu = 0;
bool muisti = false;
int kerrosPainettu;

void setup() {
  for(int napitPin = 2; napitPin <= 5; napitPin++) {
    pinMode(napitPin, INPUT);
  }

  for(int leditPin = 6; leditPin <= 9; leditPin++) {
    pinMode(leditPin, OUTPUT);
  }

  pinMode(11, OUTPUT);
  pinMode(12, OUTPUT);
  pinMode(42, INPUT);
  pinMode(44, INPUT);
  pinMode(46, INPUT);
  pinMode(48, INPUT);
  pinMode(50, INPUT);
  pinMode(52, INPUT);

}

void loop() {
  if(muisti == false) {
    digitalWrite(11, HIGH);
    digitalWrite(12, HIGH);
    muisti = true;
  }

  if (digitalRead(42) == HIGH && hissiKerros != 5) {
    hissiKerros = 1;
    tilattuKerros = 2;
    while (hissiKerros < tilattuKerros) {
      digitalWrite(6, HIGH);
      digitalWrite(11, LOW);
      if (digitalRead(46) == LOW) {
        hissiKerros = 2;
      }
    }
    digitalWrite(6, LOW);
    digitalWrite(11, HIGH);

  } else if (digitalRead(44) == HIGH && hissiKerros != 2) {
    hissiKerros = 6;
    tilattuKerros = 5;

    while (hissiKerros > tilattuKerros) {
      digitalWrite(9, HIGH);
      digitalWrite(12, LOW);
      if (digitalRead(52) == LOW) {
        hissiKerros = 5;
      }
    }
    digitalWrite(9, LOW);
    digitalWrite(12, HIGH);
  }

  for (kerrosPainettu = 0; kerrosPainettu <= 3; kerrosPainettu++) {
          switch(kerrosPainettu) {
          case 0:
            apu = 2;
            break;
          case 1:
            apu = 3;
            break;
          case 2:
            apu = 4;
            break;
          case 3:
            apu = 5;
            break;
          default:
            break;
        }
    if (digitalRead(apu) ==  HIGH) {
      tilattuKerros = apu;
    }
  }

  if (hissiKerros != tilattuKerros) {
     if (hissiKerros < tilattuKerros) {
      while (hissiKerros < tilattuKerros && digitalRead(44) == LOW) {

        switch(tilattuKerros) {
          case 2:
            palavaLedi = 6;
            break;
          case 3:
            palavaLedi = 7;
            break;
          case 4:
            palavaLedi = 8;
            break;
          case 5:
            palavaLedi = 9;
            break;
          default:
            break;
        }
        digitalWrite(12, LOW);
        digitalWrite(palavaLedi, HIGH);

        if (digitalRead(46) == LOW) { //------------KORJAA RAJA &&------------
          hissiKerros = 2;
        } else if (digitalRead(48) == LOW) {
          hissiKerros = 3;
        } else if (digitalRead(50) == LOW) {
          hissiKerros = 4;
        } else if (digitalRead(52) == LOW) {
          hissiKerros = 5;
        }
      }

      digitalWrite(12, HIGH);
      digitalWrite(palavaLedi, LOW);
      kerrosPainettu = 0;
     }

    else if (hissiKerros > tilattuKerros) {
      while (hissiKerros > tilattuKerros && digitalRead(42) == LOW) {

        switch(tilattuKerros) {
          case 2:
            palavaLedi = 6;
            break;
          case 3:
            palavaLedi = 7;
            break;
          case 4:
            palavaLedi = 8;
            break;
          case 5:
            palavaLedi = 9;
            break;
          default:
            break;
        }
        digitalWrite(11, LOW);
        digitalWrite(palavaLedi, HIGH);

        if (digitalRead(46) == LOW) { //------------KORJAA RAJA &&------------
          hissiKerros = 2;
        } else if (digitalRead(48) == LOW) {
          hissiKerros = 3;
        } else if (digitalRead(50) == LOW) {
          hissiKerros = 4;
        } else if (digitalRead(52) == LOW) {
          hissiKerros = 5;
        }
      }
      digitalWrite(11, HIGH);
      digitalWrite(palavaLedi, LOW);
      kerrosPainettu = 0;
     }
  }

}