1 files changed, 5 insertions, 0 deletions

diff --git a/firmware/target/arm/usb-drv-pp502x.c b/firmware/target/arm/usb-drv-pp502x.c
index 033546f787..e35b4da67f 100644
--- a/firmware/target/arm/usb-drv-pp502x.c
+++ b/firmware/target/arm/usb-drv-pp502x.c
@@ -560,6 +560,11 @@ void usb_drv_set_test_mode(int mode)
             REG_PORTSC1 |= PORTSCX_PTC_FORCE_EN;
             break;
     }
+    REG_USBCMD &= ~USBCMD_RUN;
+    udelay(50000);
+    REG_USBCMD |= USBCMD_CTRL_RESET;
+    while (REG_USBCMD & USBCMD_CTRL_RESET);
+    REG_USBCMD |= USBCMD_RUN;
 }
 
 /*-------------------------------------------------------------------------*/