drivers/staging/vt6655/power.c

   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  *      PSvEnablePowerSaving - Enable Power Saving Mode
  16  *      PSvDiasblePowerSaving - Disable Power Saving Mode
  17  *      PSbConsiderPowerDown - Decide if we can Power Down
  18  *      PSvSendPSPOLL - Send PS-POLL packet
  19  *      PSbSendNullPacket - Send Null packet
  20  *      PSbIsNextTBTTWakeUp - Decide if we need to wake up at next Beacon
  21  *
  22  * Revision History:
  23  *
  24  */
  25
  26 #include "mac.h"
  27 #include "device.h"
  28 #include "power.h"
  29 #include "card.h"
  30
  31 /*---------------------  Static Definitions -------------------------*/
  32
  33 /*---------------------  Static Classes  ----------------------------*/
  34
  35 /*---------------------  Static Functions  --------------------------*/
  36
  37 /*---------------------  Export Variables  --------------------------*/
  38
  39 /*---------------------  Export Functions  --------------------------*/
  40
  41 /*
  42  *
  43  * Routine Description:
  44  * Enable hw power saving functions
  45  *
  46  * Return Value:
  47  *    None.
  48  *
  49  */
  50
  51 void PSvEnablePowerSaving(struct vnt_private *priv,
  52                           unsigned short wListenInterval)
  53 {
  54         u16 wAID = priv->current_aid | BIT(14) | BIT(15);
  55
  56         /* set period of power up before TBTT */
  57         VNSvOutPortW(priv->PortOffset + MAC_REG_PWBT, C_PWBT);
  58         if (priv->op_mode != NL80211_IFTYPE_ADHOC) {
  59                 /* set AID */
  60                 VNSvOutPortW(priv->PortOffset + MAC_REG_AIDATIM, wAID);
  61         } else {
  62                 /* set ATIM Window */
  63 #if 0 /* TODO atim window */
  64                 MACvWriteATIMW(priv->PortOffset, pMgmt->wCurrATIMWindow);
  65 #endif
  66         }
  67         /* Set AutoSleep */
  68         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
  69         /* Set HWUTSF */
  70         MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
  71
  72         if (wListenInterval >= 2) {
  73                 /* clear always listen beacon */
  74                 MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
  75                 /* first time set listen next beacon */
  76                 MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_LNBCN);
  77         } else {
  78                 /* always listen beacon */
  79                 MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
  80         }
  81
  82         /* enable power saving hw function */
  83         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_PSEN);
  84         priv->bEnablePSMode = true;
  85
  86         priv->bPWBitOn = true;
  87         pr_debug("PS:Power Saving Mode Enable...\n");
  88 }
  89
  90 /*
  91  *
  92  * Routine Description:
  93  * Disable hw power saving functions
  94  *
  95  * Return Value:
  96  *    None.
  97  *
  98  */
  99
 100 void
 101 PSvDisablePowerSaving(
 102         struct vnt_private *priv
 103 )
 104 {
 105         /* disable power saving hw function */
 106         MACbPSWakeup(priv);
 107         /* clear AutoSleep */
 108         MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
 109         /* clear HWUTSF */
 110         MACvRegBitsOff(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
 111         /* set always listen beacon */
 112         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
 113
 114         priv->bEnablePSMode = false;
 115
 116         priv->bPWBitOn = false;
 117 }
 118
 119 /*
 120  *
 121  * Routine Description:
 122  * Check if Next TBTT must wake up
 123  *
 124  * Return Value:
 125  *    None.
 126  *
 127  */
 128
 129 bool
 130 PSbIsNextTBTTWakeUp(
 131         struct vnt_private *priv
 132 )
 133 {
 134         struct ieee80211_hw *hw = priv->hw;
 135         struct ieee80211_conf *conf = &hw->conf;
 136         bool wake_up = false;
 137
 138         if (conf->listen_interval > 1) {
 139                 if (!priv->wake_up_count)
 140                         priv->wake_up_count = conf->listen_interval;
 141
 142                 --priv->wake_up_count;
 143
 144                 if (priv->wake_up_count == 1) {
 145                         /* Turn on wake up to listen next beacon */
 146                         MACvRegBitsOn(priv->PortOffset,
 147                                       MAC_REG_PSCTL, PSCTL_LNBCN);
 148                         wake_up = true;
 149                 }
 150         }
 151
 152         return wake_up;
 153 }