diff --git a/hardware_integration/src/can_hardware_interface.cpp b/hardware_integration/src/can_hardware_interface.cpp index 17b9d2da..f01c7dda 100644 --- a/hardware_integration/src/can_hardware_interface.cpp +++ b/hardware_integration/src/can_hardware_interface.cpp @@ -314,9 +314,9 @@ namespace isobus return false; } - if (channel->frameHandler->get_is_valid()) + if ((channel->frameHandler->get_is_valid()) && + (channel->messagesToBeTransmittedQueue.push(frame))) { - channel->messagesToBeTransmittedQueue.push(frame); #if !defined CAN_STACK_DISABLE_THREADS && !defined ARDUINO updateThreadWakeupCondition.notify_all(); #endif