From 080f1697e97e13461ec6df4d31c8924d01257a1b Mon Sep 17 00:00:00 2001
From: Roy Ben Shabat <Roy.mail.net@gmail.com>
Date: Tue, 9 Apr 2019 01:47:48 +0300
Subject: MERGE

---
 .../Embedded/Modules/Control/MillisecTask.c        | 47 +++++++++++++++++++++-
 .../Embedded/Modules/Control/MillisecTask.h        |  2 +
 2 files changed, 47 insertions(+), 2 deletions(-)

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

diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
index d34ac9ff9..193769265 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
@@ -445,6 +445,37 @@ uint32_t MillisecLoop(uint32_t tick)
 #endif
     return OK;
 }
+int TemperatureSum[MAX_TEMPERATURE_SENSOR_ID];
+int TemperatureMin[MAX_TEMPERATURE_SENSOR_ID];
+int TemperatureMax[MAX_TEMPERATURE_SENSOR_ID];
+int TemperatureCount[MAX_TEMPERATURE_SENSOR_ID];
+int TemperatureCalc[MAX_TEMPERATURE_SENSOR_ID];
+void MillisecUpdateTemperatures (TEMPERATURE_SENSOR_ID_ENUM SensorId,int temperature)
+{
+   //if(TemperatureCount[SensorId]++>=10)
+   //    TemperatureCount[SensorId] = 0;
+    TemperatureCount[SensorId]++;
+    if (TemperatureMax[SensorId]<temperature) TemperatureMax[SensorId]=temperature;
+    if (TemperatureMin[SensorId]>temperature) TemperatureMin[SensorId]=temperature;
+    TemperatureSum[SensorId]+=temperature;
+}
+int MillisecCalculateTemperatures (TEMPERATURE_SENSOR_ID_ENUM SensorId)
+{
+    int calc = 0;
+    TemperatureSum[SensorId]-=TemperatureMax[SensorId];
+    TemperatureSum[SensorId]-=TemperatureMin[SensorId];
+    calc = TemperatureSum[SensorId] / (TemperatureCount[SensorId]-2);
+
+    TemperatureSum[SensorId] = 0;
+    TemperatureCount[SensorId] = 0;
+    TemperatureMin[SensorId] = 30000;
+    TemperatureMax[SensorId] = -30000;
+    return calc;
+}
+int MillisecGetTemperatures (TEMPERATURE_SENSOR_ID_ENUM SensorId)
+{
+    return TemperatureCalc[SensorId];
+}
 uint32_t MillisecLowLoop(uint32_t tick)
 {
     uint8_t Motor_i,Disp_i,Heater_i,temp;
@@ -454,9 +485,10 @@ uint32_t MillisecLowLoop(uint32_t tick)
     //call all modules Millisec functions
     //test dancers and speed encoders
     //check all callback units (state machine waiting for completion of a change)
-    bool Ten_msTick, Hundred_msTick, Onesecond_Tick,O900Millisecond_Tick,OneMinute_Tick;
+    bool Ten_msTick, Hundred_msTick , m90msecTick, Onesecond_Tick,O900Millisecond_Tick,OneMinute_Tick;
     Ten_msTick      =   (tick%eTenMillisecond == 0)      ?true:false;
     Hundred_msTick  =   (tick%eHundredMillisecond == 0)  ?true:false;
+    m90msecTick  =   (tick%eHundredMillisecond == 90)  ?true:false;
     O900Millisecond_Tick  =   (tick%eOneSecond == 900)           ?true:false;
     Onesecond_Tick  =   (tick%eOneSecond == 0)           ?true:false;
     OneMinute_Tick  =   (tick%eOneMinute == 0)           ?true:false;
@@ -471,13 +503,20 @@ uint32_t MillisecLowLoop(uint32_t tick)
         if(Machine_Idle_Mode == true)
             Machine_Idle_Breathing_Led();
     }
+    if (m90msecTick)
+    {
+        for (Sensor_i = 0;Sensor_i < MAX_TEMPERATURE_SENSOR_ID;Sensor_i++)
+        {
+            MillisecReadFromTempSensor(Sensor_i, NULL);
+        }
+    }
     if (Hundred_msTick)
     {
         Speed_Data = Calculate_Speed_Sensor_Velocity();
         Read_Buttons_Reg();
         for (Sensor_i = 0;Sensor_i < MAX_TEMPERATURE_SENSOR_ID;Sensor_i++)
         {
-            MillisecReadFromTempSensor(Sensor_i, NULL);
+            MillisecUpdateTemperatures (Sensor_i,TemperatureSensorRead(Sensor_i));
         }
         if (GeneralHwReady == true)
         {
@@ -517,6 +556,10 @@ uint32_t MillisecLowLoop(uint32_t tick)
             Read_Heaters_Current(Heater_i);
         }
         Gas_PPM = Calculate_Gas_Power_Consumption();
+        for (Sensor_i = 0;Sensor_i < MAX_TEMPERATURE_SENSOR_ID;Sensor_i++)
+        {
+            TemperatureCalc[Sensor_i] =  MillisecCalculateTemperatures ( Sensor_i);
+        }
     }
     if (OneMinute_Tick)
     {
diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h
index 064302685..be82d9e98 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.h
@@ -33,6 +33,8 @@ float getSensorSpeedData(void);
 uint32_t getDrawerFansStatus(void);
 uint32_t getSystemFansStatus(void);
 uint8_t getGasReading(void);
+int MillisecGetTemperatures (TEMPERATURE_SENSOR_ID_ENUM SensorId);
+
 
 void MillisecInit(void);
 void MillisecStop(void);
-- 
cgit v1.3.1