diff --git a/Src/CanSerialPortFrame.c b/Src/CanSerialPortFrame.c
index f73eb41..8cfad2e 100644
--- a/Src/CanSerialPortFrame.c
+++ b/Src/CanSerialPortFrame.c
@@ -272,10 +272,14 @@ bool vCanSerialPortFrameDMAInit(
 
 static void CanSerialPortFrameAddDataQueue(tCanSerialPortFrameFlagchip *env, can_rx_message_type *rx_message_struct,
                                            uint8_t filter) {
-    osMessageQueuePut(env->rxDataQueue[filter], rx_message_struct, 0x0, 0U);
+    osStatus_t status = osMessageQueuePut(env->rxDataQueue[filter], rx_message_struct, 0x0, 0U);
+
+    if (status != osOK) {
+        asm("nop");
+    }
 
     if (env->rxDataSnifferQueue[filter]) {
-        osMessageQueuePut(env->rxDataSnifferQueue[filter], rx_message_struct, 0x0, 0U);
+        status = osMessageQueuePut(env->rxDataSnifferQueue[filter], rx_message_struct, 0x0, 0U);
     }
 }