From 088deb6845a4f20407a01aa2fe120c27e95d60ff Mon Sep 17 00:00:00 2001
From: Avi Levkovich <avi@twine-s.com>
Date: Tue, 7 Apr 2020 15:53:25 +0300
Subject: update waste volume measurment logic

---
 .../Embedded_SW/Embedded/Modules/Control/MillisecTask.c  | 16 ++++++++++++++++
 1 file changed, 16 insertions(+)

(limited to 'Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c')

diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
index a5421e60a..84b31c322 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  ********************************************/
 
@@ -732,6 +734,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)
-- 
cgit v1.3.1