fix: include a timeout when waiting for the cmd_resp

Signed-off-by: Frederic Pillon <[email protected]>
stm32duino · Jan 11, 2024 · 8b33eb7 · 8b33eb7
1 parent e1874c7
commit 8b33eb7
Showing 1 changed file with 6 additions and 4 deletions.
diff --git a/src/utility/STM32_WPAN/shci_tl.c b/src/utility/STM32_WPAN/shci_tl.c
@@ -24,6 +24,7 @@
 #include "stm_list.h"
 #include "shci_tl.h"
 #include "stm32_def.h"
+#include "wiring_time.h"
 
 /* Private typedef -----------------------------------------------------------*/
 typedef enum
@@ -251,10 +252,11 @@ static void TlUserEvtReceived(TL_EvtPacket_t *shcievt)
 /* Weak implementation ----------------------------------------------------------------*/
 __WEAK void shci_cmd_resp_wait(uint32_t timeout)
 {
-  (void)timeout;
-
-  while(CmdRspStatusFlag != SHCI_TL_CMD_RESP_RELEASE);
-
+  for (unsigned long start = millis(); (millis() - start) < timeout;) {
+    if (CmdRspStatusFlag == SHCI_TL_CMD_RESP_RELEASE) {
+      break;
+    }
+  }
   return;
 }