diff --git a/flight/pios/stm32f4xx/libraries/STM32_USB_OTG_Driver/src/usb_dcd_int.c b/flight/pios/stm32f4xx/libraries/STM32_USB_OTG_Driver/src/usb_dcd_int.c
index d6e52c604..1c5e33d4a 100644
--- a/flight/pios/stm32f4xx/libraries/STM32_USB_OTG_Driver/src/usb_dcd_int.c
+++ b/flight/pios/stm32f4xx/libraries/STM32_USB_OTG_Driver/src/usb_dcd_int.c
@@ -681,7 +681,7 @@ static uint32_t DCD_WriteEmptyTxFifo(USB_OTG_CORE_HANDLE *pdev, uint32_t epnum)
   }
   // --- start fix
     uint32_t fifoemptymsk;
-    if (len < ep->maxpacket)
+    if (len <= ep->maxpacket)
     {
       // FIFO empty
       fifoemptymsk = 0x1 << epnum;