From da1b671bef36b771d7c417baadd8156287d481d2 Mon Sep 17 00:00:00 2001
From: Shlomo Hecht <shlomo@twine-s.com>
Date: Wed, 27 Feb 2019 16:06:23 +0200
Subject: automstic loading

---
 .../Embedded/Modules/Thread/ThreadLoad.c           | 26 +++++++++++++++++-----
 1 file changed, 20 insertions(+), 6 deletions(-)

(limited to 'Software/Embedded_SW/Embedded/Modules/Thread')

diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c b/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c
index 2689ea34a..a82fe37e6 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/ThreadLoad.c
@@ -199,6 +199,7 @@
         return OK;
     }
     uint8_t CallbackCounter = 0;
+    uint8_t TimeoutsCounter = 0;
     uint32_t Thread_Load_HomingCallback(uint32_t MotorId, uint32_t ReadValue)
     {
         Report("Thread Load State Machine Callback.",__FILE__,__LINE__,LoadStages,RpMessage,NumberOfDrierLoaderCycles,0);
@@ -206,12 +207,25 @@
         if (CallbackCounter)
         {
             CallbackCounter--;
+            if (ReadValue != LIMIT)
+            {
+                //returned with a timeout
+                TimeoutsCounter++;
+            }
             if (CallbackCounter == 0)
             {
-                LoadStages++;
-                if (LoadStages != THREAD_LOAD_INITIAL_TENSION) //on this satge we should wait for user call
+                if (TimeoutsCounter)
                 {
-                    //ThreadLoadStateMachine(LoadStages);
+                    LOG_ERROR(LoadStages,"Load sequence timeout");
+                    TimeoutsCounter = 0;
+                }
+                else
+                {
+                    LoadStages++;
+                    if (LoadStages != THREAD_LOAD_INITIAL_TENSION) //on this satge we should wait for user call
+                    {
+                        ThreadLoadStateMachine(LoadStages);
+                    }
                 }
             }
         }
@@ -326,7 +340,7 @@
         {
             Control_Dryer_Fan(START,75);//use START or STOP,  0 - 100%
             LoadStages++;
-            //ThreadLoadStateMachine(LoadStages);
+            ThreadLoadStateMachine(LoadStages);
         }
         return OK;
     }
@@ -357,7 +371,7 @@
                 LoadStages++;
                 if (LoadStages != THREAD_LOAD_INITIAL_TENSION) //on this satge we should wait for user call
                 {
-                    //ThreadLoadStateMachine(LoadStages);
+                    ThreadLoadStateMachine(LoadStages);
                 }
             }
         }
@@ -414,7 +428,7 @@
         ControlId = 0xFF;
         ThreadAbortJoggingFunc();
         LoadStages++;
-        //ThreadLoadStateMachine(LoadStages);
+        ThreadLoadStateMachine(LoadStages);
         return OK;
     }
     uint32_t Thread_Load_Jog_Thread(void)
-- 
cgit v1.3.1