2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
22 * Purpose: Handles 802.11 power management functions
29 * PSvEnablePowerSaving - Enable Power Saving Mode
30 * PSvDiasblePowerSaving - Disable Power Saving Mode
31 * PSbConsiderPowerDown - Decide if we can Power Down
32 * PSvSendPSPOLL - Send PS-POLL packet
33 * PSbSendNullPacket - Send Null packet
34 * PSbIsNextTBTTWakeUp - Decide if we need to wake up at next Beacon
49 static int msglevel = MSG_LEVEL_INFO;
53 * Routine Description:
54 * Enable hw power saving functions
61 void PSvEnablePowerSaving(struct vnt_private *pDevice, u16 wListenInterval)
63 struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
64 u16 wAID = pMgmt->wCurrAID | BIT14 | BIT15;
66 /* set period of power up before TBTT */
67 MACvWriteWord(pDevice, MAC_REG_PWBT, C_PWBT);
69 if (pDevice->op_mode != NL80211_IFTYPE_ADHOC) {
71 MACvWriteWord(pDevice, MAC_REG_AIDATIM, wAID);
74 /* Warren:06-18-2004,the sequence must follow
75 * PSEN->AUTOSLEEP->GO2DOZE
77 /* enable power saving hw function */
78 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);
81 MACvRegBitsOn(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
83 /* Warren:MUST turn on this once before turn on AUTOSLEEP ,or the
84 * AUTOSLEEP doesn't work
86 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);
88 if (wListenInterval >= 2) {
90 /* clear always listen beacon */
91 MACvRegBitsOff(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);
93 /* first time set listen next beacon */
94 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);
96 pMgmt->wCountToWakeUp = wListenInterval;
100 /* always listen beacon */
101 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);
103 pMgmt->wCountToWakeUp = 0;
106 pDevice->bEnablePSMode = true;
108 /* We don't send null pkt in ad hoc mode
109 * since beacon will handle this.
111 if (pDevice->op_mode == NL80211_IFTYPE_STATION)
112 PSbSendNullPacket(pDevice);
114 pDevice->bPWBitOn = true;
115 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "PS:Power Saving Mode Enable...\n");
120 * Routine Description:
121 * Disable hw power saving functions
128 void PSvDisablePowerSaving(struct vnt_private *pDevice)
131 /* disable power saving hw function */
132 vnt_control_out(pDevice, MESSAGE_TYPE_DISABLE_PS, 0,
135 /* clear AutoSleep */
136 MACvRegBitsOff(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
138 /* set always listen beacon */
139 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);
140 pDevice->bEnablePSMode = false;
142 if (pDevice->op_mode == NL80211_IFTYPE_STATION)
143 PSbSendNullPacket(pDevice);
145 pDevice->bPWBitOn = false;
150 * Routine Description:
151 * Consider to power down when no more packets to tx or rx.
154 * true, if power down success
158 int PSbConsiderPowerDown(struct vnt_private *pDevice, int bCheckRxDMA,
159 int bCheckCountToWakeUp)
161 struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
164 /* check if already in Doze mode */
165 vnt_control_in_u8(pDevice, MESSAGE_REQUEST_MACREG,
166 MAC_REG_PSCTL, &byData);
168 if ((byData & PSCTL_PS) != 0)
171 if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
172 /* check if in TIM wake period */
173 if (pMgmt->bInTIMWake)
177 /* check scan state */
178 if (pDevice->bCmdRunning)
182 if (pDevice->bPSModeTxBurst)
186 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);
188 if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
189 if (bCheckCountToWakeUp && (pMgmt->wCountToWakeUp == 0
190 || pMgmt->wCountToWakeUp == 1)) {
195 pDevice->bPSRxBeacon = true;
197 /* no Tx, no Rx isr, now go to Doze */
198 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);
199 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Go to Doze ZZZZZZZZZZZZZZZ\n");
205 * Routine Description:
206 * Send PS-POLL packet
213 void PSvSendPSPOLL(struct vnt_private *pDevice)
215 struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
216 struct vnt_tx_mgmt *pTxPacket = NULL;
218 memset(pMgmt->pbyPSPacketPool, 0, sizeof(struct vnt_tx_mgmt)
219 + WLAN_HDR_ADDR2_LEN);
220 pTxPacket = (struct vnt_tx_mgmt *)pMgmt->pbyPSPacketPool;
221 pTxPacket->p80211Header = (PUWLAN_80211HDR)((u8 *)pTxPacket
222 + sizeof(struct vnt_tx_mgmt));
224 pTxPacket->p80211Header->sA2.wFrameCtl = cpu_to_le16(
226 WLAN_SET_FC_FTYPE(WLAN_TYPE_CTL) |
227 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PSPOLL) |
228 WLAN_SET_FC_PWRMGT(0)
231 pTxPacket->p80211Header->sA2.wDurationID =
232 pMgmt->wCurrAID | BIT14 | BIT15;
233 memcpy(pTxPacket->p80211Header->sA2.abyAddr1, pMgmt->abyCurrBSSID,
235 memcpy(pTxPacket->p80211Header->sA2.abyAddr2, pMgmt->abyMACAddr,
237 pTxPacket->cbMPDULen = WLAN_HDR_ADDR2_LEN;
238 pTxPacket->cbPayloadLen = 0;
240 /* log failure if sending failed */
241 if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING)
242 DBG_PRT(MSG_LEVEL_DEBUG,
243 KERN_INFO "Send PS-Poll packet failed..\n");
248 * Routine Description:
249 * Send NULL packet to AP for notification power state of STA
256 int PSbSendNullPacket(struct vnt_private *pDevice)
258 struct vnt_tx_mgmt *pTxPacket = NULL;
259 struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
262 if (pDevice->bLinkPass == false)
265 if (pDevice->bEnablePSMode == false && pDevice->tx_trigger == false)
268 memset(pMgmt->pbyPSPacketPool, 0, sizeof(struct vnt_tx_mgmt)
269 + WLAN_NULLDATA_FR_MAXLEN);
270 pTxPacket = (struct vnt_tx_mgmt *)pMgmt->pbyPSPacketPool;
271 pTxPacket->p80211Header = (PUWLAN_80211HDR)((u8 *)pTxPacket
272 + sizeof(struct vnt_tx_mgmt));
274 flags = WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) |
275 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_NULL);
277 if (pDevice->bEnablePSMode)
278 flags |= WLAN_SET_FC_PWRMGT(1);
280 flags |= WLAN_SET_FC_PWRMGT(0);
282 pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(flags);
284 if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA)
285 pTxPacket->p80211Header->sA3.wFrameCtl |=
286 cpu_to_le16((u16)WLAN_SET_FC_TODS(1));
288 memcpy(pTxPacket->p80211Header->sA3.abyAddr1, pMgmt->abyCurrBSSID,
290 memcpy(pTxPacket->p80211Header->sA3.abyAddr2, pMgmt->abyMACAddr,
292 memcpy(pTxPacket->p80211Header->sA3.abyAddr3, pMgmt->abyCurrBSSID,
294 pTxPacket->cbMPDULen = WLAN_HDR_ADDR3_LEN;
295 pTxPacket->cbPayloadLen = 0;
296 /* log error if sending failed */
297 if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
298 DBG_PRT(MSG_LEVEL_DEBUG,
299 KERN_INFO "Send Null Packet failed !\n");
307 * Routine Description:
308 * Check if Next TBTT must wake up
315 int PSbIsNextTBTTWakeUp(struct vnt_private *pDevice)
317 struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
320 if (pMgmt->wListenInterval >= 2) {
321 if (pMgmt->wCountToWakeUp == 0)
322 pMgmt->wCountToWakeUp = pMgmt->wListenInterval;
324 pMgmt->wCountToWakeUp--;
326 if (pMgmt->wCountToWakeUp == 1) {
327 /* Turn on wake up to listen next beacon */
328 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);
329 pDevice->bPSRxBeacon = false;
331 } else if (!pDevice->bPSRxBeacon) {
332 /* Listen until RxBeacon */
333 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);