Professional Documents
Culture Documents
New Code
New Code
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 ;
}
}
}