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

2 files changed, 87 insertions, 3 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
index 193769265..916d33772 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
+++ b/Software/Embedded_SW/Embedded/Modules/Control/MillisecTask.c
@@ -48,6 +48,7 @@
 #include "Common/SWUpdate/FileSystem.h"
 
 #include "Communication/Connection.h"
+#include "Modules/General/buttons.h"
 
 Task_Handle Millisecond_Task_Handle;
 /******************** Definitions  ********************************************/
@@ -514,6 +515,7 @@ uint32_t MillisecLowLoop(uint32_t tick)
     {
         Speed_Data = Calculate_Speed_Sensor_Velocity();
         Read_Buttons_Reg();
+        Ink_Cart_Led();
         for (Sensor_i = 0;Sensor_i < MAX_TEMPERATURE_SENSOR_ID;Sensor_i++)
         {
             MillisecUpdateTemperatures (Sensor_i,TemperatureSensorRead(Sensor_i));
diff --git a/Software/Embedded_SW/Embedded/Modules/Control/control.c b/Software/Embedded_SW/Embedded/Modules/Control/control.c
index 608d17a7b..f1e19d851 100644
--- a/Software/Embedded_SW/Embedded/Modules/Control/control.c
+++ b/Software/Embedded_SW/Embedded/Modules/Control/control.c
@@ -158,7 +158,7 @@ uint32_t ControlActivityLed( uint32_t Parameter1)
 {
     static bool flag = false;
     static uint8_t counter;
-    const uint8_t Blink_Freq = 15;//odd number
+    const uint8_t Blink_Freq = 3;//odd number
 
     if (flag==true)
     {
@@ -166,11 +166,51 @@ uint32_t ControlActivityLed( uint32_t Parameter1)
         ACTIVITY_RED_LED_OFF; // Heaters indication - all the Heaters OFF
         if(power.color == fastBILNK)
             Pannel_Leds(POWER_ON_OFF,MODE_OFF);
-
+        else
         if((power.color == BLINK) && (counter % Blink_Freq == 0) )
         {
             Pannel_Leds(POWER_ON_OFF,MODE_OFF);
         }
+        ///////////////////////////////////////////////////////////
+        if(jog.color == fastBILNK)
+            Pannel_Leds(THREAD_JOGGING,MODE_OFF);
+        else
+        if((jog.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(THREAD_JOGGING,MODE_OFF);
+        }
+        ///////////////////////////////////////////////////////////
+        if(load.color == fastBILNK)
+            Pannel_Leds(THREAD_LOAD,MODE_OFF);
+        else
+        if((load.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(THREAD_LOAD,MODE_OFF);
+        }
+        ///////////////////////////////////////////////////////////
+        if(cart1.color == fastBILNK)
+            Pannel_Leds(CART_1,MODE_OFF);
+        else
+        if((cart1.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(CART_1,MODE_OFF);
+        }
+        ///////////////////////////////////////////////////////////
+        if(cart2.color == fastBILNK)
+            Pannel_Leds(CART_2,MODE_OFF);
+        else
+        if((cart2.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(CART_2,MODE_OFF);
+        }
+        ///////////////////////////////////////////////////////////
+        if(cart3.color == fastBILNK)
+            Pannel_Leds(CART_3,MODE_OFF);
+        else
+        if((cart3.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(CART_3,MODE_OFF);
+        }
         flag = false;
     }
     else
@@ -181,11 +221,53 @@ uint32_t ControlActivityLed( uint32_t Parameter1)
 
         if(power.color == fastBILNK)
             Pannel_Leds(POWER_ON_OFF,MODE_ON);
-
+        else
         if((power.color == BLINK) && (counter % Blink_Freq == 0) )
         {
             Pannel_Leds(POWER_ON_OFF,MODE_ON);
         }
+        ///////////////////////////////////////////////////////////
+        if(jog.color == fastBILNK)
+            Pannel_Leds(THREAD_JOGGING,MODE_ON);
+        else
+        if((jog.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(THREAD_JOGGING,MODE_ON);
+        }
+        ///////////////////////////////////////////////////////////
+        if(load.color == fastBILNK)
+            Pannel_Leds(THREAD_LOAD,MODE_ON);
+        else
+        if((load.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(THREAD_LOAD,MODE_ON);
+        }
+        ///////////////////////////////////////////////////////////
+        if(cart1.color == fastBILNK)
+            Pannel_Leds(CART_1,MODE_ON);
+        else
+        if((cart1.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(CART_1,MODE_ON);
+        }
+        ///////////////////////////////////////////////////////////
+        if(cart2.color == fastBILNK)
+            Pannel_Leds(CART_2,MODE_ON);
+        else
+        if((cart2.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(CART_2,MODE_ON);
+        }
+        ///////////////////////////////////////////////////////////
+        if(cart3.color == fastBILNK)
+            Pannel_Leds(CART_3,MODE_ON);
+        else
+        if((cart3.color == BLINK) && (counter % Blink_Freq == 0) )
+        {
+            Pannel_Leds(CART_3,MODE_ON);
+        }
+
+
 
         flag = true;
     }