Merge branch 'master' of https://twinetfs.visualstudio.com/_git/Tango

1 files changed, 30 insertions, 3 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
index 9f5ece15a..07a32b2a6 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_print.c
@@ -83,6 +83,11 @@ void ThreadInterSegmentEnded(void);
 void ThreadDistanceToSpoolEnded(void);
 uint32_t ThreadControlCBFunction(uint32_t IfIndex, uint32_t ReadValue);
 
+bool SegmentState = false;
+bool PreSegmentState = false;
+bool DTSState = false;
+void SendSegmentFail(void);
+
 double KeepNormalizedError = 0;
 bool ThreadControlActive = false;
 ////////////////////////Slow Motor State////////////////////////////////////
@@ -128,6 +133,7 @@ uint32_t Poolerinitialpos = 0xFFFF;
 
 void ThreadUpdateProcessLength (double length, void *Funcptr)
 {
+    REPORT_MSG(length,"ThreadUpdateProcessLength");
     CurrentRequestedLength = length*100;//Centimetres
     CurrentProcessedLength = 0;
     ProcessedLengthFuncPtr = (ProcessedLengthFunc)Funcptr;
@@ -436,7 +442,7 @@ uint32_t ThreadControlCBFunction(uint32_t IfIndex, uint32_t ReadValue)
                             JobEndReason = JOB_THREAD_BREAK;
                             ThreadControlActive = false;
                             SendJobProgress(0.0,0,false, TMessage);
-                            SegmentReady(Module_Thread,ModuleFail);
+                            SendSegmentFail();
                             //AlarmHandlingSetAlarm(EVENT_TYPE__THREAD_BREAK,true);
                             //EndState(CurrentJob,"ReadBreakSensor Error" );
                             LOG_ERROR(index, "ReadBreakSensor Error");
@@ -466,7 +472,7 @@ uint32_t ThreadControlCBFunction(uint32_t IfIndex, uint32_t ReadValue)
             JobEndReason = JOB_WINDER_DANCER_FAIL+DancerId;
             SendJobProgress(0.0,0,false, TMessage);
             //EndState(CurrentJob,TMessage );
-            SegmentReady(Module_Thread,ModuleFail);
+            SendSegmentFail();
             /*switch (index)
             {
                 case POOLER_MOTOR:
@@ -750,10 +756,13 @@ uint32_t ThreadPreSegmentState(void *SegmentDetails, uint32_t SegmentId)
     //set speed for both rocker motors
     //wait for all motors to get to the required speed (set the target speed for the control to check)
     //call the job state machine when the thread system is ready
-    if ((InitialProcess==false) && (EnableIntersegment == true) && (IntersegmentLength >= 1.0)) //fix - avoid intersegment length 0
+    if ((InitialProcess==false) && (EnableIntersegment == true)) //&& (IntersegmentLength >= 1.0)) //fix - avoid intersegment length 0
     {//add initial presegment and cleaning before first segment
         ThreadUpdateProcessLength (IntersegmentLength,(void *)ThreadInterSegmentEnded);
         REPORT_MSG (IntersegmentLength," ThreadPreSegmentState IntersegmentLength");
+        SegmentState = false;
+        PreSegmentState = true;
+        DTSState = false;
     }
     else
     {
@@ -766,6 +775,17 @@ uint32_t ThreadPreSegmentState(void *SegmentDetails, uint32_t SegmentId)
     return OK;
 }
 int REPSegmentId = 0;
+void SendSegmentFail(void)
+{
+    if (SegmentState == true)
+        SegmentReady(Module_Thread,ModuleFail);
+    else if (PreSegmentState == true)
+        PreSegmentReady(Module_Thread,ModuleFail);
+    else if (DTSState == true)
+        DistanceToSpoolReady(Module_Thread,ModuleFail);
+
+}
+
 void ThreadInterSegmentEnded(void)
 {
     REPORT_MSG (REPSegmentId,"ThreadInterSegmentEnded");
@@ -792,6 +812,9 @@ uint32_t ThreadSegmentState(void *SegmentDetails, int SegmentId)
     CurrentSegmentId = SegmentId;
     REPORT_MSG (seglength," ThreadSegmentState");
     ThreadUpdateProcessLength (seglength,(void *)ThreadSegmentEnded);
+    SegmentState = true;
+    PreSegmentState = false;
+    DTSState = false;
     return OK;
 }
 
@@ -801,6 +824,9 @@ uint32_t ThreadDistanceToSpoolState(void )
     seglength = dryerbufferlength;
     REPORT_MSG (seglength,"ThreadDistanceToSpoolState");
     ThreadUpdateProcessLength (seglength,(void *)ThreadDistanceToSpoolEnded);
+    SegmentState = false;
+    PreSegmentState = false;
+    DTSState = true;
     return OK;
 }
 
@@ -816,6 +842,7 @@ char Endstr[150];
      Report(Endstr,__FILE__,__LINE__,(int)TotalProcessedLength,RpWarning,(int)PoolerTotalProcessedLength,0);
 
      ThreadUpdateProcessLength (0.0,(void *)NULL);
+     TotalProcessedLength = 0.0;
     SetOriginMotorSpeed(0);
 #ifdef HUNDRED_MICROSECONDS_DANCER_READ
      MillisecLogClose();