1 files changed, 19 insertions, 37 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c
index 8c42735cb..416b53494 100644
--- a/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c
+++ b/Software/Embedded_SW/Embedded/Modules/Thread/Thread_init.c
@@ -148,12 +148,13 @@ char DancerConfigPath[50] = "0://SysInfo//DancCfg.cfg";
 
 uint32_t StoreDancerConfigMessage()
 {
-    FRESULT Fresult = FR_OK;
-    HardwareConfiguration DancerConfig;
-    HardwareDancer Dancers[MAX_SYSTEM_DANCERS];
-    uint8_t* response_buffer;
-    size_t response_size = 0;
-    int Dancer_i;
+    uint32_t status = OK;
+  /*  FRESULT Fresult = FR_OK;
+  //  HardwareConfiguration DancerConfig;
+  //  HardwareDancer Dancers[MAX_SYSTEM_DANCERS];
+  //  uint8_t* response_buffer;
+  //  size_t response_size = 0;
+  //  int Dancer_i;
 
     hardware_configuration__init(&DancerConfig);
     DancerConfig.dancers = (HardwareDancer**)my_malloc(sizeof(HardwareDancer*)*MAX_SYSTEM_DANCERS);
@@ -168,11 +169,12 @@ uint32_t StoreDancerConfigMessage()
         DancerConfig.n_dancers++;
         DancersCfg[Dancer_i].zeropoint = DancerConfig.dancers[Dancer_i]->zeropoint;
     }
-    MCU_E2PromProgram(EEPROM_STORAGE_DANCER_0,DancersCfg[0].zeropoint);
-    MCU_E2PromProgram(EEPROM_STORAGE_DANCER_1,DancersCfg[1].zeropoint);
-    MCU_E2PromProgram(EEPROM_STORAGE_DANCER_2,DancersCfg[2].zeropoint);
+    */
+    status |= MCU_E2PromProgram(EEPROM_STORAGE_DANCER_0,DancersCfg[0].zeropoint);
+    status |= MCU_E2PromProgram(EEPROM_STORAGE_DANCER_1,DancersCfg[1].zeropoint);
+    status |= MCU_E2PromProgram(EEPROM_STORAGE_DANCER_2,DancersCfg[2].zeropoint);
     Report("Store eeprom 0",__FILE__,DancersCfg[0].zeropoint,(int)DancersCfg[1].zeropoint,RpWarning,(int)DancersCfg[2].zeropoint,0);
-
+/*
     response_buffer = my_malloc(hardware_configuration__get_packed_size(&DancerConfig));
     if (response_buffer)
     {
@@ -187,43 +189,23 @@ uint32_t StoreDancerConfigMessage()
 
 
     my_free(response_buffer);
-
-    return Fresult;
+*/
+    return status;
 }
 uint32_t LoadDancerConfigMessage()
 {
-    void* buffer = NULL;
-    uint32_t Bytes = 0;
-    FRESULT Fresult = FR_OK;
-
-    HardwareConfiguration *DancerConfig;
-    int Dancer_i;
-    HardwareDancer DancersCfg1[MAX_SYSTEM_DANCERS] = {0};
-    HardwareDancer DancersCfg2[MAX_SYSTEM_DANCERS] = {0};
+    uint32_t status = OK;
 
-    memcpy(DancersCfg1,(void *)DANCERS_MAP_IN_FLASH,sizeof(DancersCfg1));
-
-    Fresult = FileRead(DancerConfigPath, &Bytes, &buffer);
-    if (Fresult == FR_OK)
-    {
-        DancerConfig = hardware_configuration__unpack(NULL, Bytes, buffer);
-        for (Dancer_i = 0; Dancer_i < DancerConfig->n_dancers ; Dancer_i++)
-        {
-            DancersCfg2[Dancer_i].zeropoint = DancerConfig->dancers[Dancer_i]->zeropoint;
-        }
-        hardware_configuration__free_unpacked(DancerConfig,NULL);
-        free (buffer);
-    }
     MCU_E2PromRead(EEPROM_STORAGE_DANCER_0,&DancersCfg[0].zeropoint);
     MCU_E2PromRead(EEPROM_STORAGE_DANCER_1,&DancersCfg[1].zeropoint);
     MCU_E2PromRead(EEPROM_STORAGE_DANCER_2,&DancersCfg[2].zeropoint);
 
 
-    Report("Dancer 0 Store data flash, internal flash, eeprom ",__FILE__,DancersCfg[0].zeropoint,(int)DancersCfg1[0].zeropoint,RpWarning,(int)DancersCfg2[0].zeropoint,0);
-    Report("Dancer 1 Store data flash, internal flash, eeprom ",__FILE__,DancersCfg[1].zeropoint,(int)DancersCfg1[1].zeropoint,RpWarning,(int)DancersCfg2[1].zeropoint,0);
-    Report("Dancer 2 Store data flash, internal flash, eeprom ",__FILE__,DancersCfg[2].zeropoint,(int)DancersCfg1[2].zeropoint,RpWarning,(int)DancersCfg2[2].zeropoint,0);
+    status |= Report("Dancer 0 Store data eeprom ",__FILE__,__LINE__,0,RpWarning,(int)DancersCfg[0].zeropoint,0);
+    status |= Report("Dancer 1 Store data eeprom ",__FILE__,__LINE__,1,RpWarning,(int)DancersCfg[1].zeropoint,0);
+    status |= Report("Dancer 2 Store data eeprom ",__FILE__,__LINE__,2,RpWarning,(int)DancersCfg[2].zeropoint,0);
 
-    return Fresult;
+    return status;
 
 }