Exit Nozzle Change if filament is loaded

Abort Nozzle change if fsensor is enabled and filament is present.
prusa3d · Aug 20, 2024 · d027c89 · d027c89
1 parent f64f2bb
commit d027c89
Showing 1 changed file with 10 additions and 0 deletions.
diff --git a/Firmware/ultralcd.cpp b/Firmware/ultralcd.cpp
@@ -984,6 +984,16 @@ void lcd_commands()
                 break;
             case 3:
 #ifndef QUICK_NOZZLE_CHANGE
+#ifdef FILAMENT_SENSOR
+                if (fsensor.isEnabled() && fsensor.getFilamentPresent()) {
+                    lcd_show_fullscreen_message_and_wait_P(_T(MSG_UNLOAD_FILAMENT_REPEAT));
+                    lcd_commands_step = 0;
+                    lcd_commands_type = LcdCommands::Idle;
+                    SetPrinterState(PrinterState::Idle);
+                    lcd_setstatuspgm(MSG_WELCOME);
+                    break;
+                }
+#endif //FILAMENT_SENSOR
                 lcd_show_fullscreen_message_and_wait_P(_T(MSG_NOZZLE_CNG_READ_HELP));
                 enquecommand_P(G28W);
                 enquecommand_P(PSTR("G1 X125 Z200 F1000"));