From 58f8fdb51ba787b4f769ea9416fb2a20364591c2 Mon Sep 17 00:00:00 2001
From: Robert Pelnar <robert.pelnar@seznam.cz>
Date: Tue, 5 Dec 2017 18:37:03 +0100
Subject: [PATCH] Automatic filament load in M600

---
 Firmware/Marlin_main.cpp | 17 +++++++++++++----
 Firmware/fsensor.cpp     |  1 +
 2 files changed, 14 insertions(+), 4 deletions(-)

diff --git a/Firmware/Marlin_main.cpp b/Firmware/Marlin_main.cpp
index 58d5aacd..549862fd 100644
--- a/Firmware/Marlin_main.cpp
+++ b/Firmware/Marlin_main.cpp
@@ -5490,12 +5490,21 @@ case 404:  //M404 Enter the nominal filament width (3mm, 1.75mm ) N<3.0> or disp
         lcd_wait_interact();
 		//load_filament_time = millis();
 		KEEPALIVE_STATE(PAUSED_FOR_USER);
-        while(!lcd_clicked()){
-
-
+		pat9125_update_y(); //update sensor
+		uint16_t y_old = pat9125_y; //save current y value
+		uint8_t change_cnt = 0; //reset number of changes counter
+        while(!lcd_clicked())
+		{
           manage_heater();
           manage_inactivity(true);
-
+          pat9125_update_y(); //update sensor
+          if (y_old != pat9125_y) //? y value is different
+          {
+			if ((y_old - pat9125_y) > 0)  //? delta-y value is positive (inserting)
+				change_cnt++; //increment change counter
+			y_old = pat9125_y; //save current value
+			if (change_cnt > 20) break; //number of positive changes > 20, start loading
+          }
 /*#ifdef SNMM
 		  target[E_AXIS] += 0.002;
 		  plan_buffer_line(target[X_AXIS], target[Y_AXIS], target[Z_AXIS], target[E_AXIS], 500, active_extruder);
diff --git a/Firmware/fsensor.cpp b/Firmware/fsensor.cpp
index 9fd346e3..33af9050 100644
--- a/Firmware/fsensor.cpp
+++ b/Firmware/fsensor.cpp
@@ -41,6 +41,7 @@ int16_t fsensor_st_cnt = 0;
 uint8_t fsensor_log = 1;
 
 
+
 bool fsensor_enable()
 {
 	puts_P(PSTR("fsensor_enable\n"));