diff --git a/Firmware/ultralcd.cpp b/Firmware/ultralcd.cpp index 4f3d6f7bd..52b0341d3 100644 --- a/Firmware/ultralcd.cpp +++ b/Firmware/ultralcd.cpp @@ -903,9 +903,20 @@ void lcd_commands() switch (lcd_commands_step) { case 0: - lcd_commands_step = 3; + lcd_commands_step = 5; [[fallthrough]]; + case 5: + enquecommand_P(G28W); + enquecommand_P(PSTR("G1 X125 Y105 Z1 F8000")); + lcd_commands_step = 4; + break; + + case 4: + st_synchronize(); + lcd_commands_step = 3; + break; + case 3: temp_model_set_warn_beep(false); enquecommand_P(PSTR("M310 A F1"));