// ------------------- OUTPUT ------
#define IN1_PUSH3 22
#define IN2_PUSH2 24
#define IN3_SLIDE 26
#define IN4_UP_DOWN 28
#define IN5_VECUUM 30
#define IN6_PUSH1 32
#define IN7_TRANSPORT2 34
#define IN8_TRANSPORT1 36
//------------------- SW Sensor ----
#define SW A0
#define SS1 A1
#define SS2 A2
#define SS3 A3

int ON=0,OFF=1;

void setup() {

  pinMode(SW,INPUT_PULLUP);
  pinMode(SS1,INPUT_PULLUP);
  pinMode(SS2,INPUT_PULLUP);
  pinMode(SS3,INPUT_PULLUP);

   pinMode(IN1_PUSH3, OUTPUT);
   pinMode(IN2_PUSH2, OUTPUT);
   pinMode(IN3_SLIDE, OUTPUT);
   pinMode(IN4_UP_DOWN, OUTPUT);
   pinMode(IN5_VECUUM, OUTPUT);
   pinMode(IN6_PUSH1, OUTPUT);
   pinMode(IN7_TRANSPORT2, OUTPUT);
   pinMode(IN8_TRANSPORT1, OUTPUT);

     //------------------- SET OFF OUTPUT -----
  digitalWrite(IN1_PUSH3, 1);
  digitalWrite(IN2_PUSH2, 1);
  digitalWrite(IN3_SLIDE, 1);
  digitalWrite(IN4_UP_DOWN, 1);
  digitalWrite(IN5_VECUUM, 1);
  digitalWrite(IN6_PUSH1, 1);
  digitalWrite(IN7_TRANSPORT2, 1);
  digitalWrite(IN8_TRANSPORT1, 1);

}

void loop() {

  delay(50);

  if(digitalRead(SW)==0)
  {
      digitalWrite(IN7_TRANSPORT2, ON);
      delay(100);

      while(digitalRead(SS2)==1 && digitalRead(SS3)==1) { delay(10);  }

      if(digitalRead(SS2)==0)
      {
         delay(450);
         digitalWrite(IN7_TRANSPORT2, OFF);
         digitalWrite(IN2_PUSH2, ON);
         delay(1500);
         digitalWrite(IN2_PUSH2, OFF); 
      }

      if(digitalRead(SS3)==0)
      {
         delay(450);
         digitalWrite(IN7_TRANSPORT2, OFF);
         digitalWrite(IN1_PUSH3, ON);
         delay(1500);
         digitalWrite(IN1_PUSH3, OFF); 
      }

  }



}