diff --git a/libuavcan_drivers/linux/apps/test_multithreading.cpp b/libuavcan_drivers/linux/apps/test_multithreading.cpp
index 3ef60bd1a4..da9ea875db 100644
--- a/libuavcan_drivers/linux/apps/test_multithreading.cpp
+++ b/libuavcan_drivers/linux/apps/test_multithreading.cpp
@@ -227,11 +227,11 @@ public:
 
             const int res = main_node.injectTxFrame(e->frame, e->deadline, iface_mask,
                                                     uavcan::CanTxQueue::Qos(e->qos), e->flags);
+            prioritized_tx_queue_.remove(e);
             if (res <= 0)
             {
                 break;
             }
-            prioritized_tx_queue_.remove(e);
         }
     }