MERGE!

1 files changed, 17 insertions, 0 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
index a5421e60a..d31ea3c05 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
@@ -61,6 +61,8 @@
 #include <Drivers/I2C_Communication/WHS_Card/D_Max5805_ADC_Blower/WHS_Blower.h>
 #include "Modules/Heaters/Heaters_ex.h"
 #include <Drivers/I2C_Communication/WHS_Card/D_EMC2302_Fan/WHS_Fan.h>
+#include <Drivers/I2C_Communication/WHS_Card/D_MAX11614_ADC/WHS_MAX11614_A2D.h>
+
 Task_Handle Millisecond_Task_Handle;
 /******************** Definitions  ********************************************/
 
@@ -619,6 +621,7 @@ uint32_t MillisecLowLoop(uint32_t tick)
     }
     if(Fifty_msTick)
     {
+        WHS_Read_GPI_Registers();
         Trigger_PT100_Read();//call every 50mSec (minimum delay 30mSec)
         //Set_HeadCard_PT100();//call every 50mSec (minimum delay 30mSec)
     }
@@ -732,6 +735,20 @@ uint32_t MillisecLowLoop(uint32_t tick)
             WHS_Blower_Avarege(HEAD_FLOW_METER);
             WHS_Blower_Avarege(DRIER_FLOW_METER);
             WHS_Start_Blower_Control_Closed_Loop ();
+
+            static uint8_t Whs_emptying_cycle = 0;
+
+            // #warning TBD need to define the timing
+            if(Whs_emptying_cycle >= 2)
+            {
+                waste_seq_step1();// include 1Sec delay
+                Whs_emptying_cycle = 0;
+            }
+            else
+            {
+                Whs_emptying_cycle++;
+            }
+
         }
     }
     if (OneMinute_Tick)