From 917d08c0c4cfd95b6bf545a857361bcf0da5ea8a Mon Sep 17 00:00:00 2001 From: Avi Levkovich Date: Thu, 6 Feb 2020 13:32:45 +0200 Subject: progress.c - update the stub - Head Card I/O (amount = 0x0EAD) --- .../Embedded/Modules/Stubs_Handler/Progress.c | 17 ++++++++++++----- 1 file changed, 12 insertions(+), 5 deletions(-) (limited to 'Software/Embedded_SW/Embedded/Modules') 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; } -- cgit v1.3.1