drivers/staging/vt6656/power.c

   1 /*
   2  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
   3  * All rights reserved.
   4  *
   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.
   9  *
  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.
  14  *
  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.
  18  *
  19  *
  20  * File: power.c
  21  *
  22  * Purpose: Handles 802.11 power management functions
  23  *
  24  * Author: Lyndon Chen
  25  *
  26  * Date: July 17, 2002
  27  *
  28  * 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
  35  *
  36  * Revision History:
  37  *
  38  */
  39
  40 #include "mac.h"
  41 #include "device.h"
  42 #include "wmgr.h"
  43 #include "power.h"
  44 #include "wcmd.h"
  45 #include "rxtx.h"
  46 #include "card.h"
  47 #include "control.h"
  48 #include "rndis.h"
  49
  50 static int msglevel = MSG_LEVEL_INFO;
  51
  52 /*
  53  *
  54  * Routine Description:
  55  * Enable hw power saving functions
  56  *
  57  * Return Value:
  58  *    None.
  59  *
  60  */
  61
  62 void PSvEnablePowerSaving(struct vnt_private *pDevice, u16 wListenInterval)
  63 {
  64         struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
  65         u16 wAID = pMgmt->wCurrAID | BIT14 | BIT15;
  66
  67         /* set period of power up before TBTT */
  68         MACvWriteWord(pDevice, MAC_REG_PWBT, C_PWBT);
  69
  70         if (pDevice->op_mode != NL80211_IFTYPE_ADHOC) {
  71                 /* set AID */
  72                 MACvWriteWord(pDevice, MAC_REG_AIDATIM, wAID);
  73         }
  74
  75         /* Warren:06-18-2004,the sequence must follow
  76          * PSEN->AUTOSLEEP->GO2DOZE
  77          */
  78         /* enable power saving hw function */
  79         MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);
  80
  81         /* Set AutoSleep */
  82         MACvRegBitsOn(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
  83
  84         /* Warren:MUST turn on this once before turn on AUTOSLEEP ,or the
  85          * AUTOSLEEP doesn't work
  86          */
  87         MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);
  88
  89         if (wListenInterval >= 2) {
  90
  91                 /* clear always listen beacon */
  92                 MACvRegBitsOff(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);
  93
  94                 /* first time set listen next beacon */
  95                 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);
  96
  97                 pMgmt->wCountToWakeUp = wListenInterval;
  98
  99         } else {
 100
 101                 /* always listen beacon */
 102                 MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);
 103
 104                 pMgmt->wCountToWakeUp = 0;
 105         }
 106
 107         pDevice->bEnablePSMode = true;
 108
 109         /* We don't send null pkt in ad hoc mode
 110          * since beacon will handle this.
 111          */
 112         if (pDevice->op_mode == NL80211_IFTYPE_STATION)
 113                 PSbSendNullPacket(pDevice);
 114
 115         pDevice->bPWBitOn = true;
 116         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "PS:Power Saving Mode Enable...\n");
 117 }
 118
 119 /*
 120  *
 121  * Routine Description:
 122  * Disable hw power saving functions
 123  *
 124  * Return Value:
 125  *    None.
 126  *
 127  */
 128
 129 void PSvDisablePowerSaving(struct vnt_private *pDevice)
 130 {
 131
 132         /* disable power saving hw function */
 133         CONTROLnsRequestOut(pDevice, MESSAGE_TYPE_DISABLE_PS, 0,
 134                                                 0, 0, NULL);
 135
 136         /* clear AutoSleep */
 137         MACvRegBitsOff(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
 138
 139         /* set always listen beacon */
 140         MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);
 141         pDevice->bEnablePSMode = false;
 142
 143         if (pDevice->op_mode == NL80211_IFTYPE_STATION)
 144                 PSbSendNullPacket(pDevice);
 145
 146         pDevice->bPWBitOn = false;
 147 }
 148
 149 /*
 150  *
 151  * Routine Description:
 152  * Consider to power down when no more packets to tx or rx.
 153  *
 154  * Return Value:
 155  *    true, if power down success
 156  *    false, if fail
 157  */
 158
 159 int PSbConsiderPowerDown(struct vnt_private *pDevice, int bCheckRxDMA,
 160         int bCheckCountToWakeUp)
 161 {
 162         struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
 163         u8 byData;
 164
 165         /* check if already in Doze mode */
 166         ControlvReadByte(pDevice, MESSAGE_REQUEST_MACREG,
 167                                         MAC_REG_PSCTL, &byData);
 168
 169         if ((byData & PSCTL_PS) != 0)
 170                 return true;
 171
 172         if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
 173                 /* check if in TIM wake period */
 174                 if (pMgmt->bInTIMWake)
 175                         return false;
 176         }
 177
 178         /* check scan state */
 179         if (pDevice->bCmdRunning)
 180                 return false;
 181
 182         /* Tx Burst */
 183         if (pDevice->bPSModeTxBurst)
 184                 return false;
 185
 186         /* Froce PSEN on */
 187         MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);
 188
 189         if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
 190                 if (bCheckCountToWakeUp && (pMgmt->wCountToWakeUp == 0
 191                         || pMgmt->wCountToWakeUp == 1)) {
 192                                 return false;
 193                 }
 194         }
 195
 196         pDevice->bPSRxBeacon = true;
 197
 198         /* no Tx, no Rx isr, now go to Doze */
 199         MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);
 200         DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Go to Doze ZZZZZZZZZZZZZZZ\n");
 201         return true;
 202 }
 203
 204 /*
 205  *
 206  * Routine Description:
 207  * Send PS-POLL packet
 208  *
 209  * Return Value:
 210  *    None.
 211  *
 212  */
 213
 214 void PSvSendPSPOLL(struct vnt_private *pDevice)
 215 {
 216         struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
 217         struct vnt_tx_mgmt *pTxPacket = NULL;
 218
 219         memset(pMgmt->pbyPSPacketPool, 0, sizeof(struct vnt_tx_mgmt)
 220                 + WLAN_HDR_ADDR2_LEN);
 221         pTxPacket = (struct vnt_tx_mgmt *)pMgmt->pbyPSPacketPool;
 222         pTxPacket->p80211Header = (PUWLAN_80211HDR)((u8 *)pTxPacket
 223                 + sizeof(struct vnt_tx_mgmt));
 224
 225         pTxPacket->p80211Header->sA2.wFrameCtl = cpu_to_le16(
 226                 (
 227                         WLAN_SET_FC_FTYPE(WLAN_TYPE_CTL) |
 228                         WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PSPOLL) |
 229                         WLAN_SET_FC_PWRMGT(0)
 230                 ));
 231
 232         pTxPacket->p80211Header->sA2.wDurationID =
 233                 pMgmt->wCurrAID | BIT14 | BIT15;
 234         memcpy(pTxPacket->p80211Header->sA2.abyAddr1, pMgmt->abyCurrBSSID,
 235                 WLAN_ADDR_LEN);
 236         memcpy(pTxPacket->p80211Header->sA2.abyAddr2, pMgmt->abyMACAddr,
 237                 WLAN_ADDR_LEN);
 238         pTxPacket->cbMPDULen = WLAN_HDR_ADDR2_LEN;
 239         pTxPacket->cbPayloadLen = 0;
 240
 241         /* log failure if sending failed */
 242         if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING)
 243                 DBG_PRT(MSG_LEVEL_DEBUG,
 244                         KERN_INFO "Send PS-Poll packet failed..\n");
 245 }
 246
 247 /*
 248  *
 249  * Routine Description:
 250  * Send NULL packet to AP for notification power state of STA
 251  *
 252  * Return Value:
 253  *    None.
 254  *
 255  */
 256
 257 int PSbSendNullPacket(struct vnt_private *pDevice)
 258 {
 259         struct vnt_tx_mgmt *pTxPacket = NULL;
 260         struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
 261         u16 flags = 0;
 262
 263         if (pDevice->bLinkPass == false)
 264                 return false;
 265
 266         if (pDevice->bEnablePSMode == false && pDevice->tx_trigger == false)
 267                 return false;
 268
 269         memset(pMgmt->pbyPSPacketPool, 0, sizeof(struct vnt_tx_mgmt)
 270                 + WLAN_NULLDATA_FR_MAXLEN);
 271         pTxPacket = (struct vnt_tx_mgmt *)pMgmt->pbyPSPacketPool;
 272         pTxPacket->p80211Header = (PUWLAN_80211HDR)((u8 *)pTxPacket
 273                 + sizeof(struct vnt_tx_mgmt));
 274
 275         flags = WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) |
 276                         WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_NULL);
 277
 278         if (pDevice->bEnablePSMode)
 279                 flags |= WLAN_SET_FC_PWRMGT(1);
 280         else
 281                 flags |= WLAN_SET_FC_PWRMGT(0);
 282
 283         pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(flags);
 284
 285         if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA)
 286                 pTxPacket->p80211Header->sA3.wFrameCtl |=
 287                         cpu_to_le16((u16)WLAN_SET_FC_TODS(1));
 288
 289         memcpy(pTxPacket->p80211Header->sA3.abyAddr1, pMgmt->abyCurrBSSID,
 290                 WLAN_ADDR_LEN);
 291         memcpy(pTxPacket->p80211Header->sA3.abyAddr2, pMgmt->abyMACAddr,
 292                 WLAN_ADDR_LEN);
 293         memcpy(pTxPacket->p80211Header->sA3.abyAddr3, pMgmt->abyCurrBSSID,
 294                 WLAN_BSSID_LEN);
 295         pTxPacket->cbMPDULen = WLAN_HDR_ADDR3_LEN;
 296         pTxPacket->cbPayloadLen = 0;
 297         /* log error if sending failed */
 298         if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
 299                 DBG_PRT(MSG_LEVEL_DEBUG,
 300                         KERN_INFO "Send Null Packet failed !\n");
 301                 return false;
 302         }
 303         return true;
 304 }
 305
 306 /*
 307  *
 308  * Routine Description:
 309  * Check if Next TBTT must wake up
 310  *
 311  * Return Value:
 312  *    None.
 313  *
 314  */
 315
 316 int PSbIsNextTBTTWakeUp(struct vnt_private *pDevice)
 317 {
 318         struct vnt_manager *pMgmt = &pDevice->vnt_mgmt;
 319         int bWakeUp = false;
 320
 321         if (pMgmt->wListenInterval >= 2) {
 322                 if (pMgmt->wCountToWakeUp == 0)
 323                         pMgmt->wCountToWakeUp = pMgmt->wListenInterval;
 324
 325                 pMgmt->wCountToWakeUp--;
 326
 327                 if (pMgmt->wCountToWakeUp == 1) {
 328                         /* Turn on wake up to listen next beacon */
 329                         MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);
 330                         pDevice->bPSRxBeacon = false;
 331                         bWakeUp = true;
 332                 } else if (!pDevice->bPSRxBeacon) {
 333                         /* Listen until RxBeacon */
 334                         MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);
 335                 }
 336         }
 337         return bWakeUp;
 338 }
 339