drivers/staging/vt6655/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 "power.h"
  43 #include "card.h"
  44
  45 /*---------------------  Static Definitions -------------------------*/
  46
  47 /*---------------------  Static Classes  ----------------------------*/
  48
  49 /*---------------------  Static Functions  --------------------------*/
  50
  51 /*---------------------  Export Variables  --------------------------*/
  52
  53 /*---------------------  Export Functions  --------------------------*/
  54
  55 /*
  56  *
  57  * Routine Description:
  58  * Enable hw power saving functions
  59  *
  60  * Return Value:
  61  *    None.
  62  *
  63  */
  64
  65 void
  66 PSvEnablePowerSaving(
  67         struct vnt_private *priv,
  68         unsigned short wListenInterval
  69 )
  70 {
  71         u16 wAID = priv->current_aid | BIT(14) | BIT(15);
  72
  73         /* set period of power up before TBTT */
  74         VNSvOutPortW(priv->PortOffset + MAC_REG_PWBT, C_PWBT);
  75         if (priv->op_mode != NL80211_IFTYPE_ADHOC) {
  76                 /* set AID */
  77                 VNSvOutPortW(priv->PortOffset + MAC_REG_AIDATIM, wAID);
  78         } else {
  79                 /* set ATIM Window */
  80 #if 0 /* TODO atim window */
  81                 MACvWriteATIMW(priv->PortOffset, pMgmt->wCurrATIMWindow);
  82 #endif
  83         }
  84         /* Set AutoSleep */
  85         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
  86         /* Set HWUTSF */
  87         MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
  88
  89         if (wListenInterval >= 2) {
  90                 /* clear always listen beacon */
  91                 MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
  92                 /* first time set listen next beacon */
  93                 MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_LNBCN);
  94         } else {
  95                 /* always listen beacon */
  96                 MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
  97         }
  98
  99         /* enable power saving hw function */
 100         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_PSEN);
 101         priv->bEnablePSMode = true;
 102
 103         priv->bPWBitOn = true;
 104         pr_debug("PS:Power Saving Mode Enable...\n");
 105 }
 106
 107 /*
 108  *
 109  * Routine Description:
 110  * Disable hw power saving functions
 111  *
 112  * Return Value:
 113  *    None.
 114  *
 115  */
 116
 117 void
 118 PSvDisablePowerSaving(
 119         struct vnt_private *priv
 120 )
 121 {
 122         /* disable power saving hw function */
 123         MACbPSWakeup(priv);
 124         /* clear AutoSleep */
 125         MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
 126         /* clear HWUTSF */
 127         MACvRegBitsOff(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
 128         /* set always listen beacon */
 129         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
 130
 131         priv->bEnablePSMode = false;
 132
 133         priv->bPWBitOn = false;
 134 }
 135
 136
 137 /*
 138  *
 139  * Routine Description:
 140  * Check if Next TBTT must wake up
 141  *
 142  * Return Value:
 143  *    None.
 144  *
 145  */
 146
 147 bool
 148 PSbIsNextTBTTWakeUp(
 149         struct vnt_private *priv
 150 )
 151 {
 152         struct ieee80211_hw *hw = priv->hw;
 153         struct ieee80211_conf *conf = &hw->conf;
 154         bool wake_up = false;
 155
 156         if (conf->listen_interval > 1) {
 157                 if (!priv->wake_up_count)
 158                         priv->wake_up_count = conf->listen_interval;
 159
 160                 --priv->wake_up_count;
 161
 162                 if (priv->wake_up_count == 1) {
 163                         /* Turn on wake up to listen next beacon */
 164                         MACvRegBitsOn(priv->PortOffset,
 165                                       MAC_REG_PSCTL, PSCTL_LNBCN);
 166                         wake_up = true;
 167                 }
 168         }
 169
 170         return wake_up;
 171 }