From e67d15360ce355ac9e675079cd5d6442e3fa1905 Mon Sep 17 00:00:00 2001
From: Shlomo Hecht <shlomo@twine-s.com>
Date: Thu, 8 Nov 2018 11:23:48 +0200
Subject: fix bugs

---
 Software/Embedded_SW/Embedded/Modules/Thread/Thread_Winder.new | 7 +++++++
 1 file changed, 7 insertions(+)

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

diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_Winder.new b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_Winder.new
index ba4a5c8e0..f33a134e1 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_Winder.new
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_Winder.new
@@ -32,6 +32,7 @@ uint32_t Winder_ScrewAtOffsetCallback(uint32_t deviceID, uint32_t BusyFlag);
 uint32_t Winder_PrepareStage2(uint32_t deviceID, uint32_t ReadValue);
 
 bool ScrewCurrentDirection = false;  //holds current screw direction
+bool BusyfirstCall = true;           //Ignores first call after activating the screw - too early
 double ScrewSpeed = 0;
 double ScrewRunningTime = 0;
 bool ScrewDirection = false;
@@ -210,6 +211,12 @@ uint32_t ScrewDirectionChange(uint32_t deviceID, uint32_t BusyFlag)
 {
     uint32_t Steps;
     double temp;
+    if (BusyfirstCall)
+    {
+        BusyfirstCall = false;
+		DirectionChangeCounter++;
+        return OK;
+    }
     //ScrewCurrentDirection: false moves out, true moves home
     if (BusyFlag == NOTBUSY)
     {
-- 
cgit v1.3.1