kernel/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  *      vnt_enable_power_saving - Enable Power Saving Mode
  30  *      PSvDiasblePowerSaving - Disable Power Saving Mode
  31  *      vnt_next_tbtt_wakeup - Decide if we need to wake up at next Beacon
  32  *
  33  * Revision History:
  34  *
  35  */
  36
  37 #include "mac.h"
  38 #include "device.h"
  39 #include "power.h"
  40 #include "wcmd.h"
  41 #include "rxtx.h"
  42 #include "card.h"
  43 #include "usbpipe.h"
  44
  45 /*
  46  *
  47  * Routine Description:
  48  * Enable hw power saving functions
  49  *
  50  * Return Value:
  51  *    None.
  52  *
  53  */
  54
  55 void vnt_enable_power_saving(struct vnt_private *priv, u16 listen_interval)
  56 {
  57         u16 aid = priv->current_aid | BIT(14) | BIT(15);
  58
  59         /* set period of power up before TBTT */
  60         vnt_mac_write_word(priv, MAC_REG_PWBT, C_PWBT);
  61
  62         if (priv->op_mode != NL80211_IFTYPE_ADHOC) {
  63                 /* set AID */
  64                 vnt_mac_write_word(priv, MAC_REG_AIDATIM, aid);
  65         }
  66
  67         /* Warren:06-18-2004,the sequence must follow
  68          * PSEN->AUTOSLEEP->GO2DOZE
  69          */
  70         /* enable power saving hw function */
  71         vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_PSEN);
  72
  73         /* Set AutoSleep */
  74         vnt_mac_reg_bits_on(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
  75
  76         /* Warren:MUST turn on this once before turn on AUTOSLEEP ,or the
  77          * AUTOSLEEP doesn't work
  78          */
  79         vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_GO2DOZE);
  80
  81         if (listen_interval >= 2) {
  82
  83                 /* clear always listen beacon */
  84                 vnt_mac_reg_bits_off(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
  85
  86                 /* first time set listen next beacon */
  87                 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_LNBCN);
  88         } else {
  89
  90                 /* always listen beacon */
  91                 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
  92         }
  93
  94         dev_dbg(&priv->usb->dev,  "PS:Power Saving Mode Enable...\n");
  95 }
  96
  97 /*
  98  *
  99  * Routine Description:
 100  * Disable hw power saving functions
 101  *
 102  * Return Value:
 103  *    None.
 104  *
 105  */
 106
 107 void vnt_disable_power_saving(struct vnt_private *priv)
 108 {
 109
 110         /* disable power saving hw function */
 111         vnt_control_out(priv, MESSAGE_TYPE_DISABLE_PS, 0,
 112                                                 0, 0, NULL);
 113
 114         /* clear AutoSleep */
 115         vnt_mac_reg_bits_off(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
 116
 117         /* set always listen beacon */
 118         vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
 119 }
 120
 121 /*
 122  *
 123  * Routine Description:
 124  * Check if Next TBTT must wake up
 125  *
 126  * Return Value:
 127  *    None.
 128  *
 129  */
 130
 131 int vnt_next_tbtt_wakeup(struct vnt_private *priv)
 132 {
 133         struct ieee80211_hw *hw = priv->hw;
 134         struct ieee80211_conf *conf = &hw->conf;
 135         int wake_up = false;
 136
 137         if (conf->listen_interval == 1) {
 138                 /* Turn on wake up to listen next beacon */
 139                 vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_LNBCN);
 140                 wake_up = true;
 141         }
 142
 143         return wake_up;
 144 }