1 files changed, 6 insertions, 6 deletions
diff --git a/os/hal/platforms/STM32/OTGv1/usb_lld.c b/os/hal/platforms/STM32/OTGv1/usb_lld.c
index 78fc45a71..c0785a2e6 100644
--- a/os/hal/platforms/STM32/OTGv1/usb_lld.c
+++ b/os/hal/platforms/STM32/OTGv1/usb_lld.c
@@ -454,6 +454,12 @@ static void otg_txfifo_handler(USBDriver *usbp, usbep_t ep) {
   while (TRUE) {
     uint32_t n;
 
+    /* Interrupt disabled on transaction end.*/
+    if (usbp->epc[ep]->in_state->txcnt >= usbp->epc[ep]->in_state->txsize) {
+      OTG->DIEPEMPMSK &= ~DIEPEMPMSK_INEPTXFEM(ep);
+      return;
+    }
+
     /* Number of bytes remaining in current transaction.*/
     n = usbp->epc[ep]->in_state->txsize - usbp->epc[ep]->in_state->txcnt;
     if (n > usbp->epc[ep]->in_maxsize)
@@ -479,12 +485,6 @@ static void otg_txfifo_handler(USBDriver *usbp, usbep_t ep) {
       usbp->epc[ep]->in_state->mode.linear.txbuf += n;
     }
     usbp->epc[ep]->in_state->txcnt += n;
-
-    /* Interrupt disabled on transaction end.*/
-    if (usbp->epc[ep]->in_state->txcnt >= usbp->epc[ep]->in_state->txsize) {
-      OTG->DIEPEMPMSK &= ~DIEPEMPMSK_INEPTXFEM(ep);
-      return;
-    }
   }
 }