mirror of https://github.com/proski/madwifi
135 lines
3.6 KiB
C
135 lines
3.6 KiB
C
/*
|
|
* Copyright (c) 2002-2008 Sam Leffler, Errno Consulting
|
|
* Copyright (c) 2002-2004 Atheros Communications, Inc.
|
|
*
|
|
* Permission to use, copy, modify, and/or distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
*
|
|
* $Id: ar5210_power.c,v 1.4 2008/11/10 04:08:02 sam Exp $
|
|
*/
|
|
#include "opt_ah.h"
|
|
|
|
#include "ah.h"
|
|
#include "ah_internal.h"
|
|
|
|
#include "ar5210/ar5210.h"
|
|
#include "ar5210/ar5210reg.h"
|
|
|
|
/*
|
|
* Notify Power Mgt is disabled in self-generated frames.
|
|
* If requested, set Power Mode of chip to auto/normal.
|
|
*/
|
|
static void
|
|
ar5210SetPowerModeAuto(struct ath_hal *ah, int setChip)
|
|
{
|
|
OS_REG_SET_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SV);
|
|
if (setChip)
|
|
OS_REG_RMW_FIELD(ah, AR_SCR, AR_SCR_SLE, AR_SCR_SLE_ALLOW);
|
|
}
|
|
|
|
/*
|
|
* Notify Power Mgt is enabled in self-generated frames.
|
|
* If requested, force chip awake.
|
|
*
|
|
* Returns A_OK if chip is awake or successfully forced awake.
|
|
*
|
|
* WARNING WARNING WARNING
|
|
* There is a problem with the chip where sometimes it will not wake up.
|
|
*/
|
|
static HAL_BOOL
|
|
ar5210SetPowerModeAwake(struct ath_hal *ah, int setChip)
|
|
{
|
|
#define POWER_UP_TIME 2000
|
|
uint32_t val;
|
|
int i;
|
|
|
|
if (setChip) {
|
|
OS_REG_RMW_FIELD(ah, AR_SCR, AR_SCR_SLE, AR_SCR_SLE_WAKE);
|
|
OS_DELAY(2000); /* Give chip the chance to awake */
|
|
|
|
for (i = POWER_UP_TIME / 200; i != 0; i--) {
|
|
val = OS_REG_READ(ah, AR_PCICFG);
|
|
if ((val & AR_PCICFG_SPWR_DN) == 0)
|
|
break;
|
|
OS_DELAY(200);
|
|
OS_REG_RMW_FIELD(ah, AR_SCR, AR_SCR_SLE,
|
|
AR_SCR_SLE_WAKE);
|
|
}
|
|
if (i == 0) {
|
|
#ifdef AH_DEBUG
|
|
ath_hal_printf(ah, "%s: Failed to wakeup in %ums\n",
|
|
__func__, POWER_UP_TIME/20);
|
|
#endif
|
|
return AH_FALSE;
|
|
}
|
|
}
|
|
|
|
OS_REG_CLR_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SV);
|
|
return AH_TRUE;
|
|
#undef POWER_UP_TIME
|
|
}
|
|
|
|
/*
|
|
* Notify Power Mgt is disabled in self-generated frames.
|
|
* If requested, force chip to sleep.
|
|
*/
|
|
static void
|
|
ar5210SetPowerModeSleep(struct ath_hal *ah, int setChip)
|
|
{
|
|
OS_REG_SET_BIT(ah, AR_STA_ID1, AR_STA_ID1_PWR_SV);
|
|
if (setChip)
|
|
OS_REG_RMW_FIELD(ah, AR_SCR, AR_SCR_SLE, AR_SCR_SLE_SLP);
|
|
}
|
|
|
|
HAL_BOOL
|
|
ar5210SetPowerMode(struct ath_hal *ah, HAL_POWER_MODE mode, int setChip)
|
|
{
|
|
struct ath_hal_5210 *ahp = AH5210(ah);
|
|
#ifdef AH_DEBUG
|
|
static const char* modes[] = {
|
|
"AWAKE",
|
|
"FULL-SLEEP",
|
|
"NETWORK SLEEP",
|
|
"UNDEFINED"
|
|
};
|
|
#endif
|
|
int status = AH_TRUE;
|
|
|
|
HALDEBUG(ah, HAL_DEBUG_POWER, "%s: %s -> %s (%s)\n", __func__,
|
|
modes[ahp->ah_powerMode], modes[mode],
|
|
setChip ? "set chip " : "");
|
|
switch (mode) {
|
|
case HAL_PM_AWAKE:
|
|
status = ar5210SetPowerModeAwake(ah, setChip);
|
|
break;
|
|
case HAL_PM_FULL_SLEEP:
|
|
ar5210SetPowerModeSleep(ah, setChip);
|
|
break;
|
|
case HAL_PM_NETWORK_SLEEP:
|
|
ar5210SetPowerModeAuto(ah, setChip);
|
|
break;
|
|
default:
|
|
HALDEBUG(ah, HAL_DEBUG_ANY, "%s: unknown power mode %u\n",
|
|
__func__, mode);
|
|
return AH_FALSE;
|
|
}
|
|
ahp->ah_powerMode = mode;
|
|
return status;
|
|
}
|
|
|
|
HAL_POWER_MODE
|
|
ar5210GetPowerMode(struct ath_hal *ah)
|
|
{
|
|
/* Just so happens the h/w maps directly to the abstracted value */
|
|
return MS(OS_REG_READ(ah, AR_SCR), AR_SCR_SLE);
|
|
}
|