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