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

1 files changed, 9 insertions, 6 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
index 1cc8e766b..0e95f4053 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
@@ -59,6 +59,8 @@
 #include <Drivers/I2C_Communication/WHS_Card/D_ADS122_PT100/WHS_PT100_ADC.h>
 #include <Drivers/I2C_Communication/I2C_Task.h>
 #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>
 Task_Handle Millisecond_Task_Handle;
 /******************** Definitions  ********************************************/
 
@@ -694,6 +696,7 @@ uint32_t MillisecLowLoop(uint32_t tick)
     if (O600Millisecond_Tick)
     {
         Trigger_WHSReadAllFanTacho ();
+        DrierHeaterVoltageSetup();
         if (RapidPressureRead == false)
         {
             for (Disp_i = 0;Disp_i < MAX_SYSTEM_DISPENSERS;Disp_i++)
@@ -704,8 +707,8 @@ uint32_t MillisecLowLoop(uint32_t tick)
     }
     if (Onesecond_Tick)
     {
-        char Lenstr[160];
-        static int Counter = 0;
+        //char Lenstr[160];
+        //static int Counter = 0;
         MachineUpdateResponseFunc();
         //KeepAliveOneSecondCall();
 
@@ -725,8 +728,8 @@ uint32_t MillisecLowLoop(uint32_t tick)
         if (WHS_Type == WHS_TYPE_NEW)
         {
             Trigger_WHS_PT100_Read_All();
-            WHS_Blower_Avarege_ORF1(); //drier
-            WHS_Blower_Avarege_ORF3(); //head
+            WHS_Blower_Avarege(HEAD_FLOW_METER);
+            WHS_Blower_Avarege(DRIER_FLOW_METER);
             WHS_Start_Blower_Control_Closed_Loop ();
         }
     }
@@ -928,7 +931,7 @@ void HundredMicroTimerInterrupt(int ARG0)
     StoreBuffer[StoreBufferId][StoreBufferCounter++] = dancer2;
     StoreBuffer[StoreBufferId][StoreBufferCounter++] = dancer3;
     /*-----------------------*/
-    //len = usprintf(&StoreBuffer[StoreBufferId][StoreBufferCounter], "\r\n%d %d %d", dancer1[dancer_count],dancer2[dancer_count],dancer3[dancer_count]);
+    //len = usprintf(&StoreBuffer[StoreBufferId][StoreBufferCounter], "%d %d %d", dancer1[dancer_count],dancer2[dancer_count],dancer3[dancer_count]);
     //StoreBufferCounter+=(len+1);
     /*-----------------------*/
     dancer1sum+=dancer1;
@@ -977,7 +980,7 @@ void MillisecLogInit(void)
     if (FileHandle == 0)
         Fresult = FR_DENIED;
     else
-        Fresult = f_open(FileHandle,MillisecPath,FA_WRITE |  FA_OPEN_ALWAYS);
+        Fresult = f_open(FileHandle,MillisecPath,FA_WRITE |  FA_OPEN_ALWAYS|FA_CREATE_ALWAYS);
     ROM_IntMasterEnable();
     return ;