// ------------------- 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);
}
}
}