USB_Options = Options;
        #endif
        
+       if (!(USB_Options & USB_OPT_REG_DISABLED))
+         USB_REG_On();
+       else
+         USB_REG_Off();
+
        #if defined(USB_CAN_BE_BOTH)
        if (Mode == USB_MODE_UID)
        {
        USB_INT_ClearAllInterrupts();
        
        USB_Controller_Reset();
-
-       if (!(USB_Options & USB_OPT_REG_DISABLED))
-         USB_REG_On();
-       else
-         USB_REG_Off();
          
        if (!(USB_Options & USB_OPT_MANUAL_PLL))
        {
 
                USB_PLL_On();
                while (!(USB_PLL_IsReady()));
-       }         
-
-       USB_CLK_Unfreeze();
+       }
 
        #if defined(USB_CAN_BE_BOTH)
        if (UIDModeSelectEnabled)
                USB_INT_Enable(USB_INT_IDTI);
        }
        #endif
+
+       USB_CLK_Unfreeze();
        
        if (USB_CurrentMode == USB_MODE_DEVICE)
        {
        #if (defined(USB_SERIES_6_AVR) || defined(USB_SERIES_7_AVR))
        USB_OTGPAD_On();
        #endif
-       
-       USB_Attach();
 }
 
 #if defined(USB_CAN_BE_DEVICE)
        USB_INT_Enable(USB_INT_VBUS);
        #endif
 
-       USB_INT_Clear(USB_INT_SUSPEND);
-       USB_INT_Enable(USB_INT_SUSPEND);
-       USB_INT_Clear(USB_INT_EORSTI);
+       Endpoint_ConfigureEndpoint(ENDPOINT_CONTROLEP, EP_TYPE_CONTROL,
+                                                          ENDPOINT_DIR_OUT, USB_ControlEndpointSize,
+                                                          ENDPOINT_BANK_SINGLE);               
+
+       USB_INT_Clear(USB_INT_SUSPI);
+       USB_INT_Enable(USB_INT_SUSPI);
        USB_INT_Enable(USB_INT_EORSTI);
+
+       USB_Attach();
 }
 #endif
 
        USB_ControlPipeSize = PIPE_CONTROLPIPE_DEFAULT_SIZE;
 
        USB_Host_HostMode_On();
-       USB_CLK_Unfreeze();
        
        USB_Host_VBUS_Auto_Off();
        USB_Host_VBUS_Manual_Enable();
 
        USB_INT_Enable(USB_INT_SRPI);
        USB_INT_Enable(USB_INT_BCERRI);
+
+       USB_Attach();
 }
 #endif