void setup() {
// put your setup code here, to run once:
}
void loop() {
Xmove = 500;
Ymove = -500;
if (Xmove < 0 ) {
Xdir = 2; // backward
}
else {
Xdir = 1; // forward
}
if (Ymove < 0 ) {
Ydir = 2; // backward
}
else {
Ydir = 1; // forward
}
if (abs(Xmove) > abs(Ymove)) {
steps = Ymove;
}
else {
steps = Xmove;
}
// זוז את כמות הצעדים הזהה
for (int i = 0; i < steps; i++) {
motorX.step(1, Xdir, SINGLE);
motorY.step(1, Ydir, SINGLE);
}
// השלם את כמות הצעדים השונה
if (abs(Xmove) > abs(Ymove)) {
motorX.step(abs(Xmove) - steps, Xdir, SINGLE);
}
else {
motorY.step(abs(Ymove) - steps, Xdir, SINGLE);
}
}
Comments