diff --git a/src/modules/uavcan/uavcan_virtual_can_driver.hpp b/src/modules/uavcan/uavcan_virtual_can_driver.hpp
index 500750c441..57b664068c 100644
--- a/src/modules/uavcan/uavcan_virtual_can_driver.hpp
+++ b/src/modules/uavcan/uavcan_virtual_can_driver.hpp
@@ -114,6 +114,14 @@ public:
 		uavcan::IsDynamicallyAllocatable<Item>::check();
 	}
 
+	~Queue()
+	{
+		while (!isEmpty())
+		{
+			pop();
+		}
+	}
+
 	bool isEmpty() const { return list_.isEmpty(); }
 
 	/**