Check semaphore acquire status
This commit is contained in:
+8
-3
@@ -119,9 +119,9 @@ void vUARTLogger(void *argument)
|
|||||||
DEBUG_PRINT("Waiting for CAN traffic...\r\n");
|
DEBUG_PRINT("Waiting for CAN traffic...\r\n");
|
||||||
|
|
||||||
#ifdef DEBUG_DUMMY_FRAME
|
#ifdef DEBUG_DUMMY_FRAME
|
||||||
#define uint32_t queue_timeout = 1000U;
|
uint32_t queue_timeout = 1000U;
|
||||||
#else
|
#else
|
||||||
#define uint32_t queue_timeout = osWaitForever;
|
uint32_t queue_timeout = osWaitForever;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef DEBUG_DUMMY_FRAME
|
#ifdef DEBUG_DUMMY_FRAME
|
||||||
@@ -131,7 +131,8 @@ void vUARTLogger(void *argument)
|
|||||||
|
|
||||||
if (osMessageQueueGet(xUARTQueue, &message, NULL, queue_timeout) == osOK)
|
if (osMessageQueueGet(xUARTQueue, &message, NULL, queue_timeout) == osOK)
|
||||||
{
|
{
|
||||||
osSemaphoreAcquire(xUARTDMASemaphore, osWaitForever);
|
if (osSemaphoreAcquire(xUARTDMASemaphore, queue_timeout) == osOK)
|
||||||
|
{
|
||||||
int len = format_can_message(tx_buffer, message.source, &message);
|
int len = format_can_message(tx_buffer, message.source, &message);
|
||||||
|
|
||||||
if (HAL_UART_Transmit_DMA(&huart1, (uint8_t*)tx_buffer, len) == HAL_OK)
|
if (HAL_UART_Transmit_DMA(&huart1, (uint8_t*)tx_buffer, len) == HAL_OK)
|
||||||
@@ -144,6 +145,10 @@ void vUARTLogger(void *argument)
|
|||||||
DEBUG_PRINT("HAL error, CAN frame NOT sent!\r\n");
|
DEBUG_PRINT("HAL error, CAN frame NOT sent!\r\n");
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
DEBUG_PRINT("ERROR: Semaphore timeout! UART might be stuck in BUSY state.\r\n");
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
/* END vUARTLoggerListen */
|
/* END vUARTLoggerListen */
|
||||||
|
|||||||
Reference in New Issue
Block a user