diff options
Diffstat (limited to 'drivers/net/wireless/rt2x00/rt2400pci.c')
-rw-r--r-- | drivers/net/wireless/rt2x00/rt2400pci.c | 28 |
1 files changed, 28 insertions, 0 deletions
diff --git a/drivers/net/wireless/rt2x00/rt2400pci.c b/drivers/net/wireless/rt2x00/rt2400pci.c index 6a977679124..1afba42cc12 100644 --- a/drivers/net/wireless/rt2x00/rt2400pci.c +++ b/drivers/net/wireless/rt2x00/rt2400pci.c | |||
@@ -524,6 +524,32 @@ static void rt2400pci_config_duration(struct rt2x00_dev *rt2x00dev, | |||
524 | rt2x00pci_register_write(rt2x00dev, CSR12, reg); | 524 | rt2x00pci_register_write(rt2x00dev, CSR12, reg); |
525 | } | 525 | } |
526 | 526 | ||
527 | static void rt2400pci_config_ps(struct rt2x00_dev *rt2x00dev, | ||
528 | struct rt2x00lib_conf *libconf) | ||
529 | { | ||
530 | enum dev_state state = | ||
531 | (libconf->conf->flags & IEEE80211_CONF_PS) ? | ||
532 | STATE_SLEEP : STATE_AWAKE; | ||
533 | u32 reg; | ||
534 | |||
535 | if (state == STATE_SLEEP) { | ||
536 | rt2x00pci_register_read(rt2x00dev, CSR20, ®); | ||
537 | rt2x00_set_field32(®, CSR20_DELAY_AFTER_TBCN, | ||
538 | (libconf->conf->beacon_int - 20) * 16); | ||
539 | rt2x00_set_field32(®, CSR20_TBCN_BEFORE_WAKEUP, | ||
540 | libconf->conf->listen_interval - 1); | ||
541 | |||
542 | /* We must first disable autowake before it can be enabled */ | ||
543 | rt2x00_set_field32(®, CSR20_AUTOWAKE, 0); | ||
544 | rt2x00pci_register_write(rt2x00dev, CSR20, reg); | ||
545 | |||
546 | rt2x00_set_field32(®, CSR20_AUTOWAKE, 1); | ||
547 | rt2x00pci_register_write(rt2x00dev, CSR20, reg); | ||
548 | } | ||
549 | |||
550 | rt2x00dev->ops->lib->set_device_state(rt2x00dev, state); | ||
551 | } | ||
552 | |||
527 | static void rt2400pci_config(struct rt2x00_dev *rt2x00dev, | 553 | static void rt2400pci_config(struct rt2x00_dev *rt2x00dev, |
528 | struct rt2x00lib_conf *libconf, | 554 | struct rt2x00lib_conf *libconf, |
529 | const unsigned int flags) | 555 | const unsigned int flags) |
@@ -537,6 +563,8 @@ static void rt2400pci_config(struct rt2x00_dev *rt2x00dev, | |||
537 | rt2400pci_config_retry_limit(rt2x00dev, libconf); | 563 | rt2400pci_config_retry_limit(rt2x00dev, libconf); |
538 | if (flags & IEEE80211_CONF_CHANGE_BEACON_INTERVAL) | 564 | if (flags & IEEE80211_CONF_CHANGE_BEACON_INTERVAL) |
539 | rt2400pci_config_duration(rt2x00dev, libconf); | 565 | rt2400pci_config_duration(rt2x00dev, libconf); |
566 | if (flags & IEEE80211_CONF_CHANGE_PS) | ||
567 | rt2400pci_config_ps(rt2x00dev, libconf); | ||
540 | } | 568 | } |
541 | 569 | ||
542 | static void rt2400pci_config_cw(struct rt2x00_dev *rt2x00dev, | 570 | static void rt2400pci_config_cw(struct rt2x00_dev *rt2x00dev, |