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