Jelajahi Sumber

Fix synopsys fifo flush during stall

Wrong FIFO was flushed in dcd_edpt_stall().
(epnum - 1) should only be used when accessing DIEPTXF registers.

For DIEPCTL and GRSTCTL epnum is correct index.
Jerzy Kasenberg 5 tahun lalu
induk
melakukan
88c5e2a37f
1 mengubah file dengan 1 tambahan dan 1 penghapusan
  1. 1 1
      src/portable/st/synopsys/dcd_synopsys.c

+ 1 - 1
src/portable/st/synopsys/dcd_synopsys.c

@@ -667,7 +667,7 @@ void dcd_edpt_stall (uint8_t rhport, uint8_t ep_addr)
     }
 
     // Flush the FIFO, and wait until we have confirmed it cleared.
-    usb_otg->GRSTCTL |= ((epnum - 1) << USB_OTG_GRSTCTL_TXFNUM_Pos);
+    usb_otg->GRSTCTL |= (epnum << USB_OTG_GRSTCTL_TXFNUM_Pos);
     usb_otg->GRSTCTL |= USB_OTG_GRSTCTL_TXFFLSH;
     while((usb_otg->GRSTCTL & USB_OTG_GRSTCTL_TXFFLSH_Msk) != 0);
   } else {