1 files changed, 15 insertions, 0 deletions
diff --git a/libmaple/usb/usb_callbacks.c b/libmaple/usb/usb_callbacks.c
index 72f97ad..5a69d4c 100644
--- a/libmaple/usb/usb_callbacks.c
+++ b/libmaple/usb/usb_callbacks.c
@@ -137,6 +137,21 @@ u8* vcomGetSetLineCoding(uint16 length) {
 void vcomSetLineState(void) {
 }
 
+static RESULT usbPowerOn(void) {
+  u16 wRegVal;
+
+  wRegVal = CNTR_FRES;
+  _SetCNTR(wRegVal);
+
+  wInterrupt_Mask = 0;
+  _SetCNTR(wInterrupt_Mask);
+  _SetISTR(0);
+  wInterrupt_Mask = CNTR_RESETM | CNTR_SUSPM | CNTR_WKUPM; // the bare minimum
+  _SetCNTR(wInterrupt_Mask);
+
+  return USB_SUCCESS;
+}
+
 void usbInit(void) {
     pInformation->Current_Configuration = 0;
     usbPowerOn();