int dirPin1=2;
int stpPin1=3;
int dirPin2=5;
int stpPin2=4;
int cnt1=0;
int cnt2=0;
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(A0, INPUT);
pinMode(A1, INPUT);
pinMode(dirPin1, OUTPUT);
pinMode(stpPin1, OUTPUT);
pinMode(dirPin2, OUTPUT);
pinMode(stpPin2, OUTPUT);
}
void loop() {
// put your main code here, to run repeatedly:
int horz=analogRead(A1);
int vert=analogRead(A0);
/*Serial.print("HORIZ: ");
Serial.print(horz);
Serial.print(", VERT: ");
Serial.println(vert);*/
Serial.print("step1: ");
Serial.print(cnt1);
Serial.print(" step2: ");
Serial.println(cnt2);
if(horz<300){
stepper(3, 2, true);
cnt1=cnt1+1;
}
if(horz>700){
stepper(3, 2, false);
cnt1=cnt1-1;
/* digitalWrite(dirPin1, HIGH);
digitalWrite(stpPin1, HIGH);
delayMicroseconds(50);
digitalWrite(stpPin1, LOW);
delayMicroseconds(50);*/
}
if(vert<300){
stepper(4, 5, false);
cnt2=cnt2-1;
}
if(vert>700){
stepper(4, 5, true);
cnt2=cnt2+1;
}
delay(69);
}
void stepper(int stpPin, int dirPin, bool dirVal)
{
digitalWrite(dirPin, dirVal);
digitalWrite(stpPin, HIGH);
delayMicroseconds(50);
digitalWrite(stpPin, LOW);
delayMicroseconds(50);
}