1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc. 4 * All rights reserved. 5 * 6 * File: power.c 7 * 8 * Purpose: Handles 802.11 power management functions 9 * 10 * Author: Lyndon Chen 11 * 12 * Date: July 17, 2002 13 * 14 * Functions: 15 * vnt_enable_power_saving - Enable Power Saving Mode 16 * PSvDiasblePowerSaving - Disable Power Saving Mode 17 * vnt_next_tbtt_wakeup - Decide if we need to wake up at next Beacon 18 * 19 * Revision History: 20 * 21 */ 22 23 #include "mac.h" 24 #include "device.h" 25 #include "power.h" 26 #include "wcmd.h" 27 #include "rxtx.h" 28 #include "card.h" 29 #include "usbpipe.h" 30 31 /* 32 * 33 * Routine Description: 34 * Enable hw power saving functions 35 * 36 * Return Value: 37 * None. 38 * 39 */ 40 41 void vnt_enable_power_saving(struct vnt_private *priv, u16 listen_interval) 42 { 43 u16 aid = priv->current_aid | BIT(14) | BIT(15); 44 45 /* set period of power up before TBTT */ 46 vnt_mac_write_word(priv, MAC_REG_PWBT, C_PWBT); 47 48 if (priv->op_mode != NL80211_IFTYPE_ADHOC) 49 /* set AID */ 50 vnt_mac_write_word(priv, MAC_REG_AIDATIM, aid); 51 52 /* Warren:06-18-2004,the sequence must follow 53 * PSEN->AUTOSLEEP->GO2DOZE 54 */ 55 /* enable power saving hw function */ 56 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_PSEN); 57 58 /* Set AutoSleep */ 59 vnt_mac_reg_bits_on(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP); 60 61 /* Warren:MUST turn on this once before turn on AUTOSLEEP ,or the 62 * AUTOSLEEP doesn't work 63 */ 64 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_GO2DOZE); 65 66 if (listen_interval >= 2) { 67 /* clear always listen beacon */ 68 vnt_mac_reg_bits_off(priv, MAC_REG_PSCTL, PSCTL_ALBCN); 69 70 /* first time set listen next beacon */ 71 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_LNBCN); 72 } else { 73 /* always listen beacon */ 74 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN); 75 } 76 77 dev_dbg(&priv->usb->dev, "PS:Power Saving Mode Enable...\n"); 78 } 79 80 /* 81 * 82 * Routine Description: 83 * Disable hw power saving functions 84 * 85 * Return Value: 86 * None. 87 * 88 */ 89 90 void vnt_disable_power_saving(struct vnt_private *priv) 91 { 92 /* disable power saving hw function */ 93 vnt_control_out(priv, MESSAGE_TYPE_DISABLE_PS, 0, 94 0, 0, NULL); 95 96 /* clear AutoSleep */ 97 vnt_mac_reg_bits_off(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP); 98 99 /* set always listen beacon */ 100 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN); 101 } 102 103 /* 104 * 105 * Routine Description: 106 * Check if Next TBTT must wake up 107 * 108 * Return Value: 109 * None. 110 * 111 */ 112 113 int vnt_next_tbtt_wakeup(struct vnt_private *priv) 114 { 115 struct ieee80211_hw *hw = priv->hw; 116 struct ieee80211_conf *conf = &hw->conf; 117 int wake_up = false; 118 119 if (conf->listen_interval > 1) { 120 /* Turn on wake up to listen next beacon */ 121 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_LNBCN); 122 wake_up = true; 123 } 124 125 return wake_up; 126 } 127