progress.c - update the stub - Head Card I/O (amount = 0x0EAD)

1 files changed, 12 insertions, 5 deletions

diff --git a/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c b/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
index c31e21e23..4d80215d2 100644
--- a/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
+++ b/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
@@ -213,17 +213,24 @@ void Stub_ProgressRequest(MessageContainer* requestContainer)
     {
         uint8_t Write_Buf[2] = {0,0};
         uint8_t Script_Slave_Add = request -> delay >> 16;
-        Write_Buf[0] = request -> delay >> 8;
+        Write_Buf[0] = (request -> delay & 0x00FF00) >> 8;
         Write_Buf[1] = request -> delay & 0x0000FF;
 
         Select_Main_Head_Mux_Channel();
-        I2C_Write(I2C_ID_HEAD_CARD, Script_Slave_Add, Write_Buf, 2);
+        if(Write_Buf[0] < 2)
+        {
+            I2C_Write(I2C_ID_HEAD_CARD, Script_Slave_Add, Write_Buf, 1);
+        }
+        else
+        {
+            I2C_Write(I2C_ID_HEAD_CARD, Script_Slave_Add, Write_Buf, 2);
+        }
 
         delayms(1);
 
-        uint8_t Read_Buf[2] = {0,0};
-        I2C_Read(I2C_ID_HEAD_CARD, Script_Slave_Add + 1, Read_Buf, 2);
-        response.progress = Read_Buf[1] << 8 | Read_Buf[0];
+        uint8_t Read_Buf[2] = {0};//,0};
+        I2C_Read(I2C_ID_HEAD_CARD, Script_Slave_Add + 1, Read_Buf, 1);//2 ?
+        response.progress = /*Read_Buf[1] << 8 | */Read_Buf[0];
         response.has_progress = true;
 
     }