X-Git-Url: https://jxself.org/git/?a=blobdiff_plain;f=carlfw%2Fusb%2Fmain.c;h=bd8428a0e39a2940f24daec3a9f8815e22bac445;hb=9e6041aee729b65a5a8bd386eb8a7fb13887fec9;hp=3d90477a1d68c703d3119d56ad497664933919d3;hpb=494de41e3596995a84e156ef9c0e15e647c69d94;p=carl9170fw.git

diff --git a/carlfw/usb/main.c b/carlfw/usb/main.c
index 3d90477..bd8428a 100644
--- a/carlfw/usb/main.c
+++ b/carlfw/usb/main.c
@@ -27,6 +27,7 @@
 #include "printf.h"
 #include "timer.h"
 #include "rom.h"
+#include "wl.h"
 #include "shared/phy.h"
 
 #ifdef CONFIG_CARL9170FW_DEBUG_USB
@@ -244,7 +245,7 @@ static void turn_power_off(void)
 				  AR9170_PWR_RESET_WLAN_MASK);
 	set(AR9170_PWR_REG_RESET, 0x0);
 
-	clock_set(false, AHB_20_22MHZ);
+	set(AR9170_PWR_REG_CLOCK_SEL, AHB_40MHZ_OSC);
 
 	set(AR9170_PWR_REG_PLL_ADDAC, 0x5163);	/* 0x502b; */
 	set(AR9170_PHY_REG_ADC_SERIAL_CTL, AR9170_PHY_ADC_SCTL_SEL_EXTERNAL_RADIO);
@@ -381,14 +382,24 @@ static void usb_handler(uint8_t usb_interrupt_level1)
 		if (usb_interrupt_level2 & AR9170_USB_INTR_SRC7_USB_SUSPEND) {
 			usb_suspend_ack();
 
-			disable_watchdog();
+			fw.suspend_mode = CARL9170_HOST_SUSPENDED;
 
-			/* GO_TO_SUSPEND stops the CPU clock too. */
-			orb(AR9170_USB_REG_MAIN_CTRL, AR9170_USB_MAIN_CTRL_GO_TO_SUSPEND);
+			if (!(fw.usb.device_feature & USB_DEVICE_REMOTE_WAKEUP)) {
+				disable_watchdog();
+
+				/* GO_TO_SUSPEND stops the CPU clock too. */
+				orb(AR9170_USB_REG_MAIN_CTRL, AR9170_USB_MAIN_CTRL_GO_TO_SUSPEND);
+			} else {
+				wlan_prepare_wol();
+			}
 		}
 
 		if (usb_interrupt_level2 & AR9170_USB_INTR_SRC7_USB_RESUME) {
 			usb_resume_ack();
+
+			fw.suspend_mode = CARL9170_HOST_AWAKE;
+			set(AR9170_USB_REG_WAKE_UP, 0);
+
 			reboot();
 		}
 	}
@@ -407,3 +418,11 @@ void handle_usb(void)
 		usb_trigger_in();
 }
 
+void usb_timer(void)
+{
+#ifdef CONFIG_CARL9170FW_WOL
+	if (fw.suspend_mode == CARL9170_AWAKE_HOST) {
+		set(AR9170_USB_REG_WAKE_UP, AR9170_USB_WAKE_UP_WAKE);
+	}
+#endif /* CONFIG_CARL9170FW_WOL */
+}