int dirPin1 = 2;
int stpPin1 = 3;
int dirPin2 = 4;
int stpPin2 = 5;
void stepper(int stpPin, int dirPin, bool dirVal) {
digitalWrite(dirPin, dirVal);
digitalWrite(stpPin, HIGH);
delayMicroseconds(50);
digitalWrite(stpPin, LOW);
delayMicroseconds(50);
delay(50);
}
void setup() {
Serial.begin(115200);
pinMode(A0, INPUT);
pinMode(A1, INPUT);
pinMode(dirPin1, OUTPUT);
pinMode(stpPin1, OUTPUT);
pinMode(dirPin2, OUTPUT);
pinMode(stpPin2, OUTPUT);
}
void loop() {
int horz = analogRead(A1);
int vert = analogRead(A0);
Serial.print("HORIZ: ");
Serial.print(horz);
Serial.print(", VERT: ");
Serial.println(vert);
if (horz > 750) {
stepper(3, 2, HIGH);
} else if (horz < 250) {
stepper(3, 2, LOW);
}
if (vert > 750) {
stepper(5, 4, HIGH);
} else if (vert < 250) {
stepper(5, 4, LOW);
}
}