carl9170 firmware: Wake-up on rx'ed Probe Request

[carl9170fw.git] / carlfw / usb / main.c

diff --git a/carlfw/usb/main.c b/carlfw/usb/main.c
index c2ad6c3d71fcc79fc4b1bc082430f796931745cd..da0ab802ab42b1d198c72bfbf7f660119f80cf3d 100644 (file)
--- a/carlfw/usb/main.c
+++ b/carlfw/usb/main.c
@@ -395,10 +395,11 @@ static void usb_handler(uint8_t usb_interrupt_level1)
                }
 
                if (usb_interrupt_level2 & AR9170_USB_INTR_SRC7_USB_RESUME) {
+                       usb_resume_ack();
+
                        fw.suspend_mode = CARL9170_HOST_AWAKE;
-                       andl(AR9170_USB_REG_WAKE_UP, AR9170_USB_WAKE_UP_WAKE);
+                       set(AR9170_USB_REG_WAKE_UP, 0);
 
-                       usb_resume_ack();
                        reboot();
                }
        }
@@ -419,9 +420,4 @@ void handle_usb(void)
 
 void usb_timer(void)
 {
-#ifdef CONFIG_CARL9170FW_WOL
-       if (fw.suspend_mode == CARL9170_AWAKE_HOST) {
-               orl(AR9170_USB_REG_WAKE_UP, AR9170_USB_WAKE_UP_WAKE);
-       }
-#endif /* CONFIG_CARL9170FW_WOL */
 }