2010-08-20 09:15:30 -06:00
|
|
|
/******************************************************************************
|
|
|
|
* rtl871x_pwrctrl.c
|
|
|
|
*
|
|
|
|
* Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
|
|
|
|
* Linux device driver for RTL8192SU
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
* more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License along with
|
|
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
|
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
|
|
|
*
|
|
|
|
* Modifications for inclusion into the Linux staging tree are
|
|
|
|
* Copyright(c) 2010 Larry Finger. All rights reserved.
|
|
|
|
*
|
|
|
|
* Contact information:
|
|
|
|
* WLAN FAE <wlanfae@realtek.com>
|
|
|
|
* Larry Finger <Larry.Finger@lwfinger.net>
|
|
|
|
*
|
|
|
|
******************************************************************************/
|
|
|
|
|
|
|
|
#define _RTL871X_PWRCTRL_C_
|
|
|
|
|
|
|
|
#include "osdep_service.h"
|
|
|
|
#include "drv_types.h"
|
|
|
|
#include "osdep_intf.h"
|
|
|
|
|
|
|
|
#define RTL8712_SDIO_LOCAL_BASE 0X10100000
|
|
|
|
#define SDIO_HCPWM (RTL8712_SDIO_LOCAL_BASE + 0x0081)
|
|
|
|
|
|
|
|
void r8712_set_rpwm(struct _adapter *padapter, u8 val8)
|
|
|
|
{
|
|
|
|
u8 rpwm;
|
|
|
|
struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
|
|
|
|
|
|
|
|
if (pwrpriv->rpwm == val8) {
|
|
|
|
if (pwrpriv->rpwm_retry == 0)
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
if ((padapter->bDriverStopped == true) ||
|
|
|
|
(padapter->bSurpriseRemoved == true))
|
|
|
|
return;
|
|
|
|
rpwm = val8 | pwrpriv->tog;
|
|
|
|
switch (val8) {
|
|
|
|
case PS_STATE_S1:
|
|
|
|
pwrpriv->cpwm = val8;
|
|
|
|
break;
|
|
|
|
case PS_STATE_S2:/* only for USB normal powersave mode use,
|
|
|
|
* temp mark some code. */
|
|
|
|
case PS_STATE_S3:
|
|
|
|
case PS_STATE_S4:
|
|
|
|
pwrpriv->cpwm = val8;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
pwrpriv->rpwm_retry = 0;
|
|
|
|
pwrpriv->rpwm = val8;
|
|
|
|
r8712_write8(padapter, 0x1025FE58, rpwm);
|
|
|
|
pwrpriv->tog += 0x80;
|
|
|
|
}
|
|
|
|
|
|
|
|
void r8712_set_ps_mode(struct _adapter *padapter, uint ps_mode, uint smart_ps)
|
|
|
|
{
|
|
|
|
struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
|
|
|
|
|
|
|
|
if (ps_mode > PM_Card_Disable)
|
|
|
|
return;
|
|
|
|
/* if driver is in active state, we dont need set smart_ps.*/
|
|
|
|
if (ps_mode == PS_MODE_ACTIVE)
|
|
|
|
smart_ps = 0;
|
|
|
|
if ((pwrpriv->pwr_mode != ps_mode) || (pwrpriv->smart_ps != smart_ps)) {
|
|
|
|
if (pwrpriv->pwr_mode == PS_MODE_ACTIVE)
|
|
|
|
pwrpriv->bSleep = true;
|
|
|
|
else
|
|
|
|
pwrpriv->bSleep = false;
|
|
|
|
pwrpriv->pwr_mode = ps_mode;
|
|
|
|
pwrpriv->smart_ps = smart_ps;
|
|
|
|
_set_workitem(&(pwrpriv->SetPSModeWorkItem));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Caller:ISR handler...
|
|
|
|
*
|
|
|
|
* This will be called when CPWM interrupt is up.
|
|
|
|
*
|
2011-02-24 23:14:23 -07:00
|
|
|
* using to update cpwn of drv; and drv will make a decision to up or
|
2010-08-20 09:15:30 -06:00
|
|
|
* down pwr level
|
|
|
|
*/
|
|
|
|
void r8712_cpwm_int_hdl(struct _adapter *padapter,
|
|
|
|
struct reportpwrstate_parm *preportpwrstate)
|
|
|
|
{
|
|
|
|
struct pwrctrl_priv *pwrpriv = &(padapter->pwrctrlpriv);
|
|
|
|
struct cmd_priv *pcmdpriv = &(padapter->cmdpriv);
|
|
|
|
|
|
|
|
if (pwrpriv->cpwm_tog == ((preportpwrstate->state) & 0x80))
|
|
|
|
return;
|
|
|
|
_cancel_timer_ex(&padapter->pwrctrlpriv. rpwm_check_timer);
|
|
|
|
_enter_pwrlock(&pwrpriv->lock);
|
|
|
|
pwrpriv->cpwm = (preportpwrstate->state) & 0xf;
|
|
|
|
if (pwrpriv->cpwm >= PS_STATE_S2) {
|
|
|
|
if (pwrpriv->alives & CMD_ALIVE)
|
|
|
|
up(&(pcmdpriv->cmd_queue_sema));
|
|
|
|
}
|
|
|
|
pwrpriv->cpwm_tog = (preportpwrstate->state) & 0x80;
|
|
|
|
up(&pwrpriv->lock);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void register_task_alive(struct pwrctrl_priv *pwrctrl, uint tag)
|
|
|
|
{
|
|
|
|
pwrctrl->alives |= tag;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void unregister_task_alive(struct pwrctrl_priv *pwrctrl, uint tag)
|
|
|
|
{
|
|
|
|
if (pwrctrl->alives & tag)
|
|
|
|
pwrctrl->alives ^= tag;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void _rpwm_check_handler (struct _adapter *padapter)
|
|
|
|
{
|
|
|
|
struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
|
|
|
|
|
|
|
|
if (padapter->bDriverStopped == true ||
|
|
|
|
padapter->bSurpriseRemoved == true)
|
|
|
|
return;
|
|
|
|
if (pwrpriv->cpwm != pwrpriv->rpwm)
|
|
|
|
_set_workitem(&(pwrpriv->rpwm_workitem));
|
|
|
|
}
|
|
|
|
|
|
|
|
static void SetPSModeWorkItemCallback(struct work_struct *work)
|
|
|
|
{
|
|
|
|
struct pwrctrl_priv *pwrpriv = container_of(work,
|
|
|
|
struct pwrctrl_priv, SetPSModeWorkItem);
|
|
|
|
struct _adapter *padapter = container_of(pwrpriv,
|
|
|
|
struct _adapter, pwrctrlpriv);
|
|
|
|
if (!pwrpriv->bSleep) {
|
2012-02-08 18:42:03 -07:00
|
|
|
_enter_pwrlock(&pwrpriv->lock);
|
2010-08-20 09:15:30 -06:00
|
|
|
if (pwrpriv->pwr_mode == PS_MODE_ACTIVE)
|
|
|
|
r8712_set_rpwm(padapter, PS_STATE_S4);
|
2012-02-08 18:42:03 -07:00
|
|
|
up(&pwrpriv->lock);
|
2010-08-20 09:15:30 -06:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rpwm_workitem_callback(struct work_struct *work)
|
|
|
|
{
|
|
|
|
struct pwrctrl_priv *pwrpriv = container_of(work,
|
|
|
|
struct pwrctrl_priv, rpwm_workitem);
|
|
|
|
struct _adapter *padapter = container_of(pwrpriv,
|
|
|
|
struct _adapter, pwrctrlpriv);
|
|
|
|
u8 cpwm = pwrpriv->cpwm;
|
|
|
|
if (pwrpriv->cpwm != pwrpriv->rpwm) {
|
2012-02-08 18:42:03 -07:00
|
|
|
_enter_pwrlock(&pwrpriv->lock);
|
2010-08-20 09:15:30 -06:00
|
|
|
cpwm = r8712_read8(padapter, SDIO_HCPWM);
|
|
|
|
pwrpriv->rpwm_retry = 1;
|
|
|
|
r8712_set_rpwm(padapter, pwrpriv->rpwm);
|
2012-02-08 18:42:03 -07:00
|
|
|
up(&pwrpriv->lock);
|
2010-08-20 09:15:30 -06:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rpwm_check_handler (void *FunctionContext)
|
|
|
|
{
|
|
|
|
struct _adapter *adapter = (struct _adapter *)FunctionContext;
|
|
|
|
_rpwm_check_handler(adapter);
|
|
|
|
}
|
|
|
|
|
|
|
|
void r8712_init_pwrctrl_priv(struct _adapter *padapter)
|
|
|
|
{
|
|
|
|
struct pwrctrl_priv *pwrctrlpriv = &padapter->pwrctrlpriv;
|
|
|
|
|
|
|
|
memset((unsigned char *)pwrctrlpriv, 0, sizeof(struct pwrctrl_priv));
|
|
|
|
sema_init(&pwrctrlpriv->lock, 1);
|
|
|
|
pwrctrlpriv->cpwm = PS_STATE_S4;
|
|
|
|
pwrctrlpriv->pwr_mode = PS_MODE_ACTIVE;
|
|
|
|
pwrctrlpriv->smart_ps = 0;
|
|
|
|
pwrctrlpriv->tog = 0x80;
|
|
|
|
/* clear RPWM to ensure driver and fw back to initial state. */
|
|
|
|
r8712_write8(padapter, 0x1025FE58, 0);
|
|
|
|
_init_workitem(&(pwrctrlpriv->SetPSModeWorkItem),
|
|
|
|
SetPSModeWorkItemCallback, padapter);
|
|
|
|
_init_workitem(&(pwrctrlpriv->rpwm_workitem),
|
|
|
|
rpwm_workitem_callback, padapter);
|
|
|
|
_init_timer(&(pwrctrlpriv->rpwm_check_timer),
|
|
|
|
padapter->pnetdev, rpwm_check_handler, (u8 *)padapter);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
Caller: r8712_cmd_thread
|
|
|
|
|
|
|
|
Check if the fw_pwrstate is okay for issuing cmd.
|
|
|
|
If not (cpwm should be is less than P2 state), then the sub-routine
|
|
|
|
will raise the cpwm to be greater than or equal to P2.
|
|
|
|
|
|
|
|
Calling Context: Passive
|
|
|
|
|
|
|
|
Return Value:
|
|
|
|
|
|
|
|
_SUCCESS: r8712_cmd_thread can issue cmds to firmware afterwards.
|
|
|
|
_FAIL: r8712_cmd_thread can not do anything.
|
|
|
|
*/
|
|
|
|
sint r8712_register_cmd_alive(struct _adapter *padapter)
|
|
|
|
{
|
|
|
|
uint res = _SUCCESS;
|
|
|
|
struct pwrctrl_priv *pwrctrl = &padapter->pwrctrlpriv;
|
|
|
|
|
|
|
|
_enter_pwrlock(&pwrctrl->lock);
|
|
|
|
register_task_alive(pwrctrl, CMD_ALIVE);
|
|
|
|
if (pwrctrl->cpwm < PS_STATE_S2) {
|
|
|
|
r8712_set_rpwm(padapter, PS_STATE_S3);
|
|
|
|
res = _FAIL;
|
|
|
|
}
|
|
|
|
up(&pwrctrl->lock);
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
Caller: ISR
|
|
|
|
|
|
|
|
If ISR's txdone,
|
|
|
|
No more pkts for TX,
|
|
|
|
Then driver shall call this fun. to power down firmware again.
|
|
|
|
*/
|
|
|
|
|
|
|
|
void r8712_unregister_cmd_alive(struct _adapter *padapter)
|
|
|
|
{
|
|
|
|
struct pwrctrl_priv *pwrctrl = &padapter->pwrctrlpriv;
|
|
|
|
|
|
|
|
_enter_pwrlock(&pwrctrl->lock);
|
|
|
|
unregister_task_alive(pwrctrl, CMD_ALIVE);
|
|
|
|
if ((pwrctrl->cpwm > PS_STATE_S2) &&
|
|
|
|
(pwrctrl->pwr_mode > PS_MODE_ACTIVE)) {
|
|
|
|
if ((pwrctrl->alives == 0) &&
|
|
|
|
(check_fwstate(&padapter->mlmepriv,
|
|
|
|
_FW_UNDER_LINKING) != true)) {
|
|
|
|
r8712_set_rpwm(padapter, PS_STATE_S0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
up(&pwrctrl->lock);
|
|
|
|
}
|