int echo = 9;
int trigger = 10;
int DirPin = 12;
int StepPin = 13;
int lmp = 5;
void setup() {
pinMode(DirPin, OUTPUT);
pinMode(StepPin, OUTPUT);
pinMode(trigger, OUTPUT);
pinMode(echo, INPUT);
pinMode(lmp, OUTPUT);
}
void loop() {
digitalWrite(trigger, HIGH);
delayMicroseconds(10);
digitalWrite(trigger, LOW);
int duration = pulseIn(echo, HIGH);
int cm = duration * 0.034 / 2;
if(cm < 200){
digitalWrite( DirPin, HIGH);
for(int i = 0 ; i < 200 ; i++){
digitalWrite(lmp , HIGH);
digitalWrite( StepPin, HIGH);
digitalWrite( StepPin, LOW);
delay(5); // 5 * 200 = 1 second //
}
delay(1000);
}
else{
digitalWrite( DirPin, LOW);
for(int i = 0 ; i < 200 ; i++){
digitalWrite(lmp , LOW);
digitalWrite( StepPin, HIGH);
digitalWrite( StepPin, LOW);
delay(5); // 5 * 200 = 1 second //
}
delay(1000);
}
}