Ensure device address latch bit is not set at the same time as the new address, as...

[pub/USBasp.git] / LUFA / Drivers / USB / LowLevel / Host.c

diff --git a/LUFA/Drivers/USB/LowLevel/Host.c b/LUFA/Drivers/USB/LowLevel/Host.c
index 2b66e28..6c66083 100644 (file)
--- a/LUFA/Drivers/USB/LowLevel/Host.c
+++ b/LUFA/Drivers/USB/LowLevel/Host.c
@@ -194,19 +194,21 @@ void USB_Host_ProcessNextHostState(void)
 
 uint8_t USB_Host_WaitMS(uint8_t MS)
 {
-       bool     BusSuspended        = USB_Host_IsBusSuspended();
-       uint8_t  ErrorCode           = HOST_WAITERROR_Successful;
-       uint16_t PreviousFrameNumber = USB_Host_GetFrameNumber();
+       bool    BusSuspended = USB_Host_IsBusSuspended();
+       uint8_t ErrorCode    = HOST_WAITERROR_Successful;
        
        USB_Host_ResumeBus();
 
+       bool HSOFIEnabled = USB_INT_IsEnabled(USB_INT_HSOFI);
+
+       USB_INT_Disable(USB_INT_HSOFI);
+       USB_INT_Clear(USB_INT_HSOFI);
+
        while (MS)
        {
-               uint16_t CurrentFrameNumber = USB_Host_GetFrameNumber();
-
-               if (CurrentFrameNumber != PreviousFrameNumber)
+               if (USB_INT_HasOccurred(USB_INT_HSOFI))
                {
-                       PreviousFrameNumber = CurrentFrameNumber;
+                       USB_INT_Clear(USB_INT_HSOFI);
                        MS--;
                }
                                        
@@ -234,6 +236,9 @@ uint8_t USB_Host_WaitMS(uint8_t MS)
                }
        }
 
+       if (HSOFIEnabled)
+         USB_INT_Enable(USB_INT_HSOFI);
+
        if (BusSuspended)
          USB_Host_SuspendBus();