From 62116b12831867e501300deb928f238966b97f52 Mon Sep 17 00:00:00 2001
From: 3d-gussner <3d.gussner@gmail.com>
Date: Thu, 30 Sep 2021 18:18:34 +0200
Subject: [PATCH] Update debug

---
 src/logic/feed_to_bondtech.cpp |  6 ++++--
 src/logic/feed_to_finda.cpp    | 11 ++++++++++-
 2 files changed, 14 insertions(+), 3 deletions(-)

diff --git a/src/logic/feed_to_bondtech.cpp b/src/logic/feed_to_bondtech.cpp
index 617728c..081c6b4 100644
--- a/src/logic/feed_to_bondtech.cpp
+++ b/src/logic/feed_to_bondtech.cpp
@@ -22,6 +22,7 @@ bool FeedToBondtech::Step() {
     switch (state) {
     case EngagingIdler:
         if (mi::idler.Engaged()) {
+            dbg_logic_P(PSTR("Feed to Bondtech --> Idler engaged"));
             dbg_logic_sprintf_P(PSTR("Pulley start steps %u"), mm::motion.CurPosition(mm::Pulley));
             state = PushingFilament;
             mm::motion.InitAxis(mm::Pulley);
@@ -30,7 +31,7 @@ bool FeedToBondtech::Step() {
         }
         return false;
     case PushingFilament:
-        dbg_logic_P(PSTR("Feed to Bondtech --> Pushing"));
+        //dbg_logic_P(PSTR("Feed to Bondtech --> Pushing"));
         if (mfs::fsensor.Pressed()) {
             mm::motion.AbortPlannedMoves(); // stop pushing filament
             mi::idler.Disengage();
@@ -44,8 +45,9 @@ bool FeedToBondtech::Step() {
         }
         return false;
     case DisengagingIdler:
-        dbg_logic_P(PSTR("Feed to Bondtech --> DisengagingIdler"));
         if (!mi::idler.Engaged()) {
+            dbg_logic_P(PSTR("Feed to Bondtech --> Idler disengaged"));
+            dbg_logic_sprintf_P(PSTR("Pulley end steps %u"), mm::motion.CurPosition(mm::Pulley));
             state = OK;
             mm::motion.Disable(mm::Pulley);
             ml::leds.SetMode(mg::globals.ActiveSlot(), ml::green, ml::on);
diff --git a/src/logic/feed_to_finda.cpp b/src/logic/feed_to_finda.cpp
index 2d64c40..87e5933 100644
--- a/src/logic/feed_to_finda.cpp
+++ b/src/logic/feed_to_finda.cpp
@@ -7,10 +7,11 @@
 #include "../modules/motion.h"
 #include "../modules/permanent_storage.h"
 #include "../modules/user_input.h"
-
+#include "../debug.h"
 namespace logic {
 
 void FeedToFinda::Reset(bool feedPhaseLimited) {
+    dbg_logic_P(PSTR("\nFeed to FINDA\n\n"));
     state = EngagingIdler;
     this->feedPhaseLimited = feedPhaseLimited;
     ml::leds.SetMode(mg::globals.ActiveSlot(), ml::green, ml::blink0);
@@ -23,6 +24,8 @@ bool FeedToFinda::Step() {
     switch (state) {
     case EngagingIdler:
         if (mi::idler.Engaged() && ms::selector.Slot() == mg::globals.ActiveSlot()) {
+            dbg_logic_P(PSTR("Feed to Finda --> Idler engaged"));
+            dbg_logic_sprintf_P(PSTR("Pulley start steps %u"), mm::motion.CurPosition(mm::Pulley));
             state = PushingFilament;
             mm::motion.InitAxis(mm::Pulley);
             mm::motion.PlanMove<mm::Pulley>(config::feedToFinda, config::pulleyFeedrate);
@@ -35,6 +38,8 @@ bool FeedToFinda::Step() {
             mm::motion.AbortPlannedMoves(); // stop pushing filament
             // FINDA triggered - that means it works and detected the filament tip
             mg::globals.SetFilamentLoaded(mg::FilamentLoadState::InSelector);
+            dbg_logic_P(PSTR("Feed to Finda --> Idler disengaged"));
+            dbg_logic_sprintf_P(PSTR("Pulley end steps %u"), mm::motion.CurPosition(mm::Pulley));
             state = OK;
         } else if (mm::motion.QueueEmpty()) { // all moves have been finished and FINDA didn't switch on
             state = Failed;
@@ -44,7 +49,11 @@ bool FeedToFinda::Step() {
     }
         return false;
     case OK:
+        dbg_logic_P(PSTR("Feed to FINDA OK"));
+        return true;
     case Failed:
+        dbg_logic_P(PSTR("Feed to FINDA FAILED"));
+        return true;
     default:
         return true;
     }