From e9910a9078e56e211968fb4508d4579413ee183b Mon Sep 17 00:00:00 2001
From: akukan <alexandr@prusa3d.cz>
Date: Wed, 20 Jul 2016 16:05:20 +0200
Subject: [PATCH] Print farm confirmation

---
 Firmware/ultralcd.cpp | 40 ++++++++++++++++++++++++++++++++++++++++
 1 file changed, 40 insertions(+)

diff --git a/Firmware/ultralcd.cpp b/Firmware/ultralcd.cpp
index 9b9f64f0..6afcd59a 100644
--- a/Firmware/ultralcd.cpp
+++ b/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() {