|
|
|
@ -2064,13 +2064,10 @@ void Temperature::isr() {
|
|
|
|
|
#if ENABLED(BABYSTEPPING)
|
|
|
|
|
LOOP_XYZ(axis) {
|
|
|
|
|
const int curTodo = babystepsTodo[axis]; // get rid of volatile for performance
|
|
|
|
|
if (curTodo > 0) {
|
|
|
|
|
stepper.babystep((AxisEnum)axis, /*fwd*/true);
|
|
|
|
|
babystepsTodo[axis]--;
|
|
|
|
|
}
|
|
|
|
|
else if (curTodo < 0) {
|
|
|
|
|
stepper.babystep((AxisEnum)axis, /*fwd*/false);
|
|
|
|
|
babystepsTodo[axis]++;
|
|
|
|
|
if (curTodo) {
|
|
|
|
|
stepper.babystep((AxisEnum)axis, curTodo > 0);
|
|
|
|
|
if (curTodo > 0) babystepsTodo[axis]--;
|
|
|
|
|
else babystepsTodo[axis]++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#endif // BABYSTEPPING
|
|
|
|
|