Hi all, 2012/7/18 Henning Heinold <heinold@xxxxxxxxxxxxxxxx>: > On Wed, Jul 18, 2012 at 04:40:27PM +0800, Chen, Chien-Chia wrote: >> This patch is going to fix the resuming failed from S3/S4 >> for rt3290 chip. >> >> Signed-off-by: Chen, Chien-Chia <machen@xxxxxxxx> >> >> diff --git a/drivers/net/wireless/rt2x00/rt2800lib.c b/drivers/net/wireless/rt2x00/rt2800lib.c >> index e76f03c..1715776 100644 >> --- a/drivers/net/wireless/rt2x00/rt2800lib.c >> +++ b/drivers/net/wireless/rt2x00/rt2800lib.c >> @@ -400,6 +400,13 @@ int rt2800_load_firmware(struct rt2x00_dev *rt2x00dev, >> { >> unsigned int i; >> u32 reg; >> + int retval; >> + >> + if (rt2x00_rt(rt2x00dev,RT3290)){ >> + retval = rt2800_enable_wlan_rt3290(rt2x00dev); >> + if (retval) >> + return -EBUSY; >> + } >> >> /* >> * If driver doesn't wake up firmware here, >> @@ -5152,6 +5159,65 @@ int rt2800_get_survey(struct ieee80211_hw *hw, int idx, >> } >> EXPORT_SYMBOL_GPL(rt2800_get_survey); >> >> +int rt2800_enable_wlan_rt3290(struct rt2x00_dev *rt2x00dev) >> +{ >> + u32 reg; >> + int i, count; >> + >> + rt2800_register_read(rt2x00dev, WLAN_FUN_CTRL, ®); >> + if ((rt2x00_get_field32(reg, WLAN_EN) == 1)) >> + return 0; >> + >> + rt2x00_set_field32(®, WLAN_GPIO_OUT_OE_BIT_ALL, 0xff); >> + rt2x00_set_field32(®, FRC_WL_ANT_SET, 1); >> + rt2x00_set_field32(®, WLAN_CLK_EN, 0); >> + rt2x00_set_field32(®, WLAN_EN, 1); >> + rt2800_register_write(rt2x00dev, WLAN_FUN_CTRL, reg); >> + >> + udelay(REGISTER_BUSY_DELAY); >> + count = 0; >> + do { >> + /* >> + * Check PLL_LD & XTAL_RDY. >> + */ >> + for (i = 0; i < REGISTER_BUSY_COUNT; i++) { >> + rt2800_register_read(rt2x00dev, CMB_CTRL, ®); >> + if ((rt2x00_get_field32(reg, PLL_LD) == 1) && >> + (rt2x00_get_field32(reg, XTAL_RDY) == 1)) >> + break; >> + udelay(REGISTER_BUSY_DELAY); >> + } >> + if (i >= REGISTER_BUSY_COUNT) { >> + if (count >= 10) >> + return -EIO; >> + >> + rt2800_register_write(rt2x00dev, 0x58, 0x018); >> + udelay(REGISTER_BUSY_DELAY); >> + rt2800_register_write(rt2x00dev, 0x58, 0x418); >> + udelay(REGISTER_BUSY_DELAY); >> + rt2800_register_write(rt2x00dev, 0x58, 0x618); >> + udelay(REGISTER_BUSY_DELAY); >> + count++; >> + } else { >> + count = 0; >> + } >> + >> + rt2800_register_read(rt2x00dev, WLAN_FUN_CTRL, ®); >> + rt2x00_set_field32(®, PCIE_APP0_CLK_REQ, 0); >> + rt2x00_set_field32(®, WLAN_CLK_EN, 1); >> + rt2x00_set_field32(®, WLAN_RESET, 1); >> + rt2800_register_write(rt2x00dev, WLAN_FUN_CTRL, reg); >> + udelay(10); >> + rt2x00_set_field32(®, WLAN_RESET, 0); >> + rt2800_register_write(rt2x00dev, WLAN_FUN_CTRL, reg); >> + udelay(10); >> + rt2800_register_write(rt2x00dev, INT_SOURCE_CSR, 0x7fffffff); >> + } while (count != 0); >> + >> + return 0; >> +} >> +EXPORT_SYMBOL_GPL(rt2800_enable_wlan_rt3290); >> + >> MODULE_AUTHOR(DRV_PROJECT ", Bartlomiej Zolnierkiewicz"); >> MODULE_VERSION(DRV_VERSION); >> MODULE_DESCRIPTION("Ralink RT2800 library"); >> diff --git a/drivers/net/wireless/rt2x00/rt2800lib.h b/drivers/net/wireless/rt2x00/rt2800lib.h >> index 18a0b67..12d6eeb 100644 >> --- a/drivers/net/wireless/rt2x00/rt2800lib.h >> +++ b/drivers/net/wireless/rt2x00/rt2800lib.h >> @@ -209,5 +209,5 @@ int rt2800_ampdu_action(struct ieee80211_hw *hw, struct ieee80211_vif *vif, >> int rt2800_get_survey(struct ieee80211_hw *hw, int idx, >> struct survey_info *survey); >> void rt2800_disable_wpdma(struct rt2x00_dev *rt2x00dev); >> - >> +int rt2800_enable_wlan_rt3290(struct rt2x00_dev *rt2x00dev); >> #endif /* RT2800LIB_H */ >> diff --git a/drivers/net/wireless/rt2x00/rt2800pci.c b/drivers/net/wireless/rt2x00/rt2800pci.c >> index 235376e..135c2a2 100644 >> --- a/drivers/net/wireless/rt2x00/rt2800pci.c >> +++ b/drivers/net/wireless/rt2x00/rt2800pci.c >> @@ -980,6 +980,7 @@ static int rt2800pci_validate_eeprom(struct rt2x00_dev *rt2x00dev) >> return rt2800_validate_eeprom(rt2x00dev); >> } >> >> +#if 0 >> static int rt2800_enable_wlan_rt3290(struct rt2x00_dev *rt2x00dev) >> { >> u32 reg; >> @@ -1040,6 +1041,8 @@ static int rt2800_enable_wlan_rt3290(struct rt2x00_dev *rt2x00dev) >> >> return 0; >> } >> + >> +#endif > > Why do you need the #ifdefs here? If this is no need anymore here, then I will remove this and submit it again. :) >> static int rt2800pci_probe_hw(struct rt2x00_dev *rt2x00dev) >> { >> int retval; >> > > Bye Henning > -- Thank you. -- To unsubscribe from this list: send the line "unsubscribe linux-wireless" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html