1 files changed, 5 insertions, 9 deletions
diff --git a/software/mpu/usb-cdc-shell.c b/software/mpu/usb-cdc-shell.c
index e2fb452..cd7ea15 100644
--- a/software/mpu/usb-cdc-shell.c
+++ b/software/mpu/usb-cdc-shell.c
@@ -60,6 +60,9 @@
 
 #include "usb-cdc-shell.h"
 #include "usb-cdc-descriptor.h"
+#include "board-utils.h"
+
+#include "utils.h"
 
 static SerialUSBDriver SDU1;
 
@@ -319,15 +322,8 @@ int8_t usbCDCShellRun(void)
 {
   sduObjectInit(&SDU1);
   sduStart(&SDU1, &serusbcfg);
-
-  palSetPad(GPIOA, GPIOA_USB_DISC);
-  usbDisconnectBus(serusbcfg.usbp);
-
-  chThdSleepMilliseconds(100);
-
   usbStart(serusbcfg.usbp, &usbcfg);
-  usbConnectBus(serusbcfg.usbp);
-  palClearPad(GPIOA, GPIOA_USB_DISC);
+  usbConnect(serusbcfg.usbp);
 
   shellInit();
 
@@ -344,9 +340,9 @@ int8_t usbCDCShellRun(void)
     chThdSleepMilliseconds(1000);
   }
 
+  usbDisconnect(serusbcfg.usbp);
   usbStop(serusbcfg.usbp);
   sduStop(&SDU1);
-  palSetPad(GPIOA, GPIOA_USB_DISC);
 
   return shell_return_code;
 }