Преглед на файлове

Print farm confirmation

akukan преди 8 години
родител
ревизия
e9910a9078
променени са 1 файла, в които са добавени 40 реда и са изтрити 0 реда
  1. 40 0
      Firmware/ultralcd.cpp

+ 40 - 0
Firmware/ultralcd.cpp

@@ -568,6 +568,46 @@ void lcd_commands()
 		lcd_commands_type = 0;
 	}
 
+	if (lcd_commands_type == 4)   /// farm mode confirm
+	{
+
+		if (lcd_commands_step == 0) { lcd_commands_step = 6; custom_message = true; }
+
+		if (lcd_commands_step == 1 && !blocks_queued())
+		{
+			lcd_confirm_print();
+			lcd_commands_step = 0;
+			lcd_commands_type = 0;
+		}
+		if (lcd_commands_step == 2 && !blocks_queued())
+		{
+			lcd_commands_step = 1;
+		}
+		if (lcd_commands_step == 3 && !blocks_queued())
+		{
+			lcd_commands_step = 2;
+		}
+		if (lcd_commands_step == 4 && !blocks_queued())
+		{
+			enquecommand_P(PSTR("G90"));
+			enquecommand_P(PSTR("G1 X"  STRINGIFY(X_CANCEL_POS) " Y" STRINGIFY(Y_CANCEL_POS) " E0 F7000"));
+			lcd_commands_step = 3;
+		}
+		if (lcd_commands_step == 5 && !blocks_queued())
+		{
+			lcd_commands_step = 4;
+		}
+		if (lcd_commands_step == 6 && !blocks_queued())
+		{
+			enquecommand_P(PSTR("G91"));
+			enquecommand_P(PSTR("G1 Z15 F1500"));
+			st_synchronize();
+			lcd_commands_step = 5;
+		}
+
+	}
+
+
 }
 
 static void lcd_return_to_status() {