diff --git a/gpio.c b/gpio.c
--- a/gpio.c
+++ b/gpio.c
@@ -130,12 +130,18 @@ void init_gpio(void) {
   /*Enable or disable the AHB peripheral clock */
   RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOA, ENABLE);
 
+  GPIO_InitTypeDef GPIO_InitStruct3;
+  
   /*Configure GPIO pin : PA */
-  GPIO_InitStruct.GPIO_Pin = GPIO_Pin_11|GPIO_Pin_12;
-  GPIO_InitStruct.GPIO_Mode = GPIO_Mode_AF;
-  GPIO_InitStruct.GPIO_PuPd = GPIO_PuPd_NOPULL;
-  GPIO_InitStruct.GPIO_Speed = GPIO_Speed_400KHz;
-  GPIO_Init(GPIOA, &GPIO_InitStruct);
+  GPIO_InitStruct3.GPIO_Pin = GPIO_Pin_11|GPIO_Pin_12;
+  GPIO_InitStruct3.GPIO_Mode = GPIO_Mode_AF;
+  GPIO_InitStruct3.GPIO_PuPd = GPIO_PuPd_NOPULL;
+  GPIO_InitStruct3.GPIO_Speed = GPIO_Speed_10MHz;
+  GPIO_InitStruct3.GPIO_OType = GPIO_OType_PP;
+  GPIO_Init(GPIOA, &GPIO_InitStruct3);
+  GPIO_SetBits(GPIOA, GPIO_Pin_12); // emz test
+  GPIO_PinAFConfig(GPIOA, GPIO_PinSource11, GPIO_AF_USB);
+  GPIO_PinAFConfig(GPIOA, GPIO_PinSource12, GPIO_AF_USB);
 }
 
 // vim:softtabstop=4 shiftwidth=4 expandtab 
diff --git a/main.c b/main.c
--- a/main.c
+++ b/main.c
@@ -96,9 +96,12 @@ int main(void)
     }
 
     // Init USB
-//    Set_USBClock();
-//    USB_Interrupts_Config();
-//    USB_Init();
+    //Set_System(); // hw_config.h
+    Set_USBClock();
+    USB_Interrupts_Config();
+    USB_Init();
+    //SYSCFG_USBPuCmd(ENABLE);
+    //PowerOn();
 
     // Startup screen 
     ssd1306_DrawString("therm v0.1", 1, 40);