You are on page 1of 1

#define DIR 12

#define STEP 13
boolean L1=LOW,L2=LOW,S1=LOW,S2=LOW,Y1,Y2;

void setup()
{
pinMode(6,INPUT);
pinMode(9,INPUT);
pinMode(10,INPUT);
pinMode(11,INPUT);
pinMode(DIR,OUTPUT);
pinMode(STEP,OUTPUT);
digitalWrite(DIR,LOW);
digitalWrite(STEP,LOW);

void loop()
{
//do
//{
L1=digitalRead(6);
L2=digitalRead(9);
S1=digitalRead(10);
S2=digitalRead(11);
Y1 = L1 && (!S1);
Y2 = L2 && (!S2);
//}while(Y1 || Y2 ==LOW);
if(Y1==HIGH)
{digitalWrite(DIR,LOW);
digitalWrite(STEP,HIGH);
delay(2);
digitalWrite(STEP,LOW);
delay(2);
}
if(Y2==HIGH)
{digitalWrite(DIR,HIGH);
digitalWrite(STEP,HIGH);
delay(2);
digitalWrite(STEP,LOW);
delay(2);
}

You might also like