Download as txt, pdf, or txt
Download as txt, pdf, or txt
You are on page 1of 4

const byte IR = 7 ;

const int stepPin1 = 3;


const int dirPin1 = 4;
const int stepPin2 = 5;
const int dirPin2 = 6;
int i ;
int t ;

void setup() {

pinMode(IR, INPUT);
pinMode(stepPin1,OUTPUT);
pinMode(dirPin1,OUTPUT);
pinMode(stepPin2,OUTPUT);
pinMode(dirPin2,OUTPUT);
}
void loop() {
int state = digitalRead(IR);
if (state == LOW) {
t = 800 ;
digitalWrite(dirPin1,LOW);
digitalWrite(dirPin2,LOW);
for(int x = 0; x < 533; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t -1 ;
}

digitalWrite(dirPin1,LOW);
digitalWrite(dirPin2,LOW);
for(int x = 0; x < 533; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
t = 800 ;
digitalWrite(dirPin1,HIGH);
digitalWrite(dirPin2,HIGH);
for(int x = 0; x < 222; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t -1 ;
}
digitalWrite(dirPin1,HIGH);
for(int x = 0; x < 311; x++) {
digitalWrite(stepPin1,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
delayMicroseconds(t);
}
digitalWrite(dirPin1,HIGH);
digitalWrite(dirPin2,HIGH);
for(int x = 0; x < 222; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
digitalWrite(dirPin1,HIGH);
for(int x = 0; x < 311; x++) {
digitalWrite(stepPin1,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
t = 800 ;
digitalWrite(dirPin1,LOW);
digitalWrite(dirPin2,LOW);
for(int x = 0; x < 89; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t - 1 ;
}
digitalWrite(dirPin1,LOW);
for(int x = 0; x < 178; x++) {
digitalWrite(stepPin1,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
delayMicroseconds(t);
t = t - 1 ;
}
digitalWrite(dirPin1,LOW);
digitalWrite(dirPin2,LOW);
for(int x = 0; x < 89; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
digitalWrite(dirPin1,LOW);
for(int x = 0; x < 178; x++) {
digitalWrite(stepPin1,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
t = 800 ;
digitalWrite(dirPin1,LOW);
digitalWrite(dirPin2,HIGH);
for(int x = 0; x < 150; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t - 1 ;
}
digitalWrite(dirPin1,LOW);
digitalWrite(dirPin2,HIGH);
for(int x = 0; x < 150; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
digitalWrite(dirPin2,HIGH);
for(int x = 0; x < 400; x++) {
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t + 1 ;
}

t = 800 ;
digitalWrite(dirPin1,HIGH);
digitalWrite(dirPin2,HIGH);
for(int x = 0; x < 90; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t - 1 ;
}
digitalWrite(dirPin1,HIGH);
digitalWrite(dirPin2,HIGH);
for(int x = 0; x < 90; x++) {
digitalWrite(stepPin1,HIGH);
digitalWrite(stepPin2,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
digitalWrite(stepPin2,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
digitalWrite(dirPin1,HIGH);
for(int x = 0; x < 134; x++) {
digitalWrite(stepPin1,HIGH);
delayMicroseconds(t);
digitalWrite(stepPin1,LOW);
delayMicroseconds(t);
t = t + 1 ;
}
}
}

You might also like