LXR linux/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
  55void 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
 107void 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
 131int 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}
 145