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         }
  62
  63         /* Set AutoSleep */
  64         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
  65
  66         /* Set HWUTSF */
  67         MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
  68
  69         if (wListenInterval >= 2) {
  70                 /* clear always listen beacon */
  71                 MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
  72                 /* first time set listen next beacon */
  73                 MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_LNBCN);
  74         } else {
  75                 /* always listen beacon */
  76                 MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
  77         }
  78
  79         /* enable power saving hw function */
  80         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_PSEN);
  81         priv->bEnablePSMode = true;
  82
  83         priv->bPWBitOn = true;
  84         pr_debug("PS:Power Saving Mode Enable...\n");
  85 }
  86
  87 /*
  88  *
  89  * Routine Description:
  90  * Disable hw power saving functions
  91  *
  92  * Return Value:
  93  *    None.
  94  *
  95  */
  96
  97 void PSvDisablePowerSaving(struct vnt_private *priv)
  98 {
  99         /* disable power saving hw function */
 100         MACbPSWakeup(priv);
 101
 102         /* clear AutoSleep */
 103         MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
 104
 105         /* clear HWUTSF */
 106         MACvRegBitsOff(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
 107
 108         /* set always listen beacon */
 109         MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
 110
 111         priv->bEnablePSMode = false;
 112
 113         priv->bPWBitOn = false;
 114 }
 115
 116 /*
 117  *
 118  * Routine Description:
 119  * Check if Next TBTT must wake up
 120  *
 121  * Return Value:
 122  *    None.
 123  *
 124  */
 125
 126 bool PSbIsNextTBTTWakeUp(struct vnt_private *priv)
 127 {
 128         struct ieee80211_hw *hw = priv->hw;
 129         struct ieee80211_conf *conf = &hw->conf;
 130         bool wake_up = false;
 131
 132         if (conf->listen_interval > 1) {
 133                 if (!priv->wake_up_count)
 134                         priv->wake_up_count = conf->listen_interval;
 135
 136                 --priv->wake_up_count;
 137
 138                 if (priv->wake_up_count == 1) {
 139                         /* Turn on wake up to listen next beacon */
 140                         MACvRegBitsOn(priv->PortOffset,
 141                                       MAC_REG_PSCTL, PSCTL_LNBCN);
 142                         wake_up = true;
 143                 }
 144         }
 145
 146         return wake_up;
 147 }