Quick hack to fix issues with delay in st_go_idle hanging during the stepper isr