diff --git a/Firmware/temperature.cpp b/Firmware/temperature.cpp index 2d2d3098..ab60e34e 100644 --- a/Firmware/temperature.cpp +++ b/Firmware/temperature.cpp @@ -1879,14 +1879,18 @@ ISR(TIMER0_COMPB_vect) if(curTodo>0) { + asm("cli"); babystep(axis,/*fwd*/true); babystepsTodo[axis]--; //less to do next time + asm("sei"); } else if(curTodo<0) { + asm("cli"); babystep(axis,/*fwd*/false); babystepsTodo[axis]++; //less to do next time + asm("sei"); } } #endif //BABYSTEPPING