[deliverable/linux.git] / drivers / net / wireless / rtlwifi / ps.c

/******************************************************************************
 *
 * Copyright(c) 2009-2010  Realtek Corporation.
 *
 * 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
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 * Contact Information:
 * wlanfae <wlanfae@realtek.com>
 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
 * Hsinchu 300, Taiwan.
 *
 * Larry Finger <Larry.Finger@lwfinger.net>
 *
 *****************************************************************************/

#include "wifi.h"
#include "base.h"
#include "ps.h"

bool rtl_ps_enable_nic(struct ieee80211_hw *hw)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	bool init_status = true;

	/*<1> reset trx ring */
	if (rtlhal->interface == INTF_PCI)
		rtlpriv->intf_ops->reset_trx_ring(hw);

	if (is_hal_stop(rtlhal))
		RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
			 ("Driver is already down!\n"));

	/*<2> Enable Adapter */
	rtlpriv->cfg->ops->hw_init(hw);
	RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC);
	/*init_status = false; */

	/*<3> Enable Interrupt */
	rtlpriv->cfg->ops->enable_interrupt(hw);

	/*<enable timer> */
	rtl_watch_dog_timer_callback((unsigned long)hw);

	return init_status;
}
EXPORT_SYMBOL(rtl_ps_enable_nic);

bool rtl_ps_disable_nic(struct ieee80211_hw *hw)
{
	bool status = true;
	struct rtl_priv *rtlpriv = rtl_priv(hw);

	/*<1> Stop all timer */
	rtl_deinit_deferred_work(hw);

	/*<2> Disable Interrupt */
	rtlpriv->cfg->ops->disable_interrupt(hw);

	/*<3> Disable Adapter */
	rtlpriv->cfg->ops->hw_disable(hw);

	return status;
}
EXPORT_SYMBOL(rtl_ps_disable_nic);

bool rtl_ps_set_rf_state(struct ieee80211_hw *hw,
			 enum rf_pwrstate state_toset,
			 u32 changesource, bool protect_or_not)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	enum rf_pwrstate rtstate;
	bool actionallowed = false;
	u16 rfwait_cnt = 0;
	unsigned long flag;

	/*protect_or_not = true; */

	if (protect_or_not)
		goto no_protect;

	/*
	 *Only one thread can change
	 *the RF state at one time, and others
	 *should wait to be executed.
	 */
	while (true) {
		spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flag);
		if (ppsc->rfchange_inprogress) {
			spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock,
					       flag);

			RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
				 ("RF Change in progress!"
				  "Wait to set..state_toset(%d).\n",
				  state_toset));

			/* Set RF after the previous action is done.  */
			while (ppsc->rfchange_inprogress) {
				rfwait_cnt++;
				mdelay(1);

				/*
				 *Wait too long, return false to avoid
				 *to be stuck here.
				 */
				if (rfwait_cnt > 100)
					return false;
			}
		} else {
			ppsc->rfchange_inprogress = true;
			spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock,
					       flag);
			break;
		}
	}

no_protect:
	rtstate = ppsc->rfpwr_state;

	switch (state_toset) {
	case ERFON:
		ppsc->rfoff_reason &= (~changesource);

		if ((changesource == RF_CHANGE_BY_HW) &&
		    (ppsc->hwradiooff == true)) {
			ppsc->hwradiooff = false;
		}

		if (!ppsc->rfoff_reason) {
			ppsc->rfoff_reason = 0;
			actionallowed = true;
		}

		break;

	case ERFOFF:

		if ((changesource == RF_CHANGE_BY_HW)
		    && (ppsc->hwradiooff == false)) {
			ppsc->hwradiooff = true;
		}

		ppsc->rfoff_reason |= changesource;
		actionallowed = true;
		break;

	case ERFSLEEP:
		ppsc->rfoff_reason |= changesource;
		actionallowed = true;
		break;

	default:
		RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
			 ("switch case not process\n"));
		break;
	}

	if (actionallowed)
		rtlpriv->cfg->ops->set_rf_power_state(hw, state_toset);

	if (!protect_or_not) {
		spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flag);
		ppsc->rfchange_inprogress = false;
		spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flag);
	}

	return actionallowed;
}
EXPORT_SYMBOL(rtl_ps_set_rf_state);

static void _rtl_ps_inactive_ps(struct ieee80211_hw *hw)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));

	ppsc->swrf_processing = true;

	if (ppsc->inactive_pwrstate == ERFON && rtlhal->interface == INTF_PCI) {
		if ((ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM) &&
		    RT_IN_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_ASPM) &&
		    rtlhal->interface == INTF_PCI) {
			rtlpriv->intf_ops->disable_aspm(hw);
			RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_ASPM);
		}
	}

	rtl_ps_set_rf_state(hw, ppsc->inactive_pwrstate,
			    RF_CHANGE_BY_IPS, false);

	if (ppsc->inactive_pwrstate == ERFOFF &&
	    rtlhal->interface == INTF_PCI) {
		if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM) {
			rtlpriv->intf_ops->enable_aspm(hw);
			RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_ASPM);
		}
	}

	ppsc->swrf_processing = false;
}

void rtl_ips_nic_off_wq_callback(void *data)
{
	struct rtl_works *rtlworks =
	    container_of_dwork_rtl(data, struct rtl_works, ips_nic_off_wq);
	struct ieee80211_hw *hw = rtlworks->hw;
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	enum rf_pwrstate rtstate;

	if (mac->opmode != NL80211_IFTYPE_STATION) {
		RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
			 ("not station return\n"));
		return;
	}

	if (is_hal_stop(rtlhal))
		return;

	if (rtlpriv->sec.being_setkey)
		return;

	if (ppsc->inactiveps) {
		rtstate = ppsc->rfpwr_state;

		/*
		 *Do not enter IPS in the following conditions:
		 *(1) RF is already OFF or Sleep
		 *(2) swrf_processing (indicates the IPS is still under going)
		 *(3) Connectted (only disconnected can trigger IPS)
		 *(4) IBSS (send Beacon)
		 *(5) AP mode (send Beacon)
		 *(6) monitor mode (rcv packet)
		 */

		if (rtstate == ERFON &&
		    !ppsc->swrf_processing &&
		    (mac->link_state == MAC80211_NOLINK) &&
		    !mac->act_scanning) {
			RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE,
				 ("IPSEnter(): Turn off RF.\n"));

			ppsc->inactive_pwrstate = ERFOFF;
			ppsc->in_powersavemode = true;

			/*rtl_pci_reset_trx_ring(hw); */
			_rtl_ps_inactive_ps(hw);
		}
	}
}

void rtl_ips_nic_off(struct ieee80211_hw *hw)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);

	/*
	 *because when link with ap, mac80211 will ask us
	 *to disable nic quickly after scan before linking,
	 *this will cause link failed, so we delay 100ms here
	 */
	queue_delayed_work(rtlpriv->works.rtl_wq,
			   &rtlpriv->works.ips_nic_off_wq, MSECS(100));
}

void rtl_ips_nic_on(struct ieee80211_hw *hw)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	enum rf_pwrstate rtstate;
	unsigned long flags;

	spin_lock_irqsave(&rtlpriv->locks.ips_lock, flags);

	if (ppsc->inactiveps) {
		rtstate = ppsc->rfpwr_state;

		if (rtstate != ERFON &&
		    !ppsc->swrf_processing &&
		    ppsc->rfoff_reason <= RF_CHANGE_BY_IPS) {

			ppsc->inactive_pwrstate = ERFON;
			ppsc->in_powersavemode = false;

			_rtl_ps_inactive_ps(hw);
		}
	}

	spin_unlock_irqrestore(&rtlpriv->locks.ips_lock, flags);
}

/*for FW LPS*/

/*
 *Determine if we can set Fw into PS mode
 *in current condition.Return TRUE if it
 *can enter PS mode.
 */
static bool rtl_get_fwlps_doze(struct ieee80211_hw *hw)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	u32 ps_timediff;

	ps_timediff = jiffies_to_msecs(jiffies -
				       ppsc->last_delaylps_stamp_jiffies);

	if (ps_timediff < 2000) {
		RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
			 ("Delay enter Fw LPS for DHCP, ARP,"
			  " or EAPOL exchanging state.\n"));
		return false;
	}

	if (mac->link_state != MAC80211_LINKED)
		return false;

	if (mac->opmode == NL80211_IFTYPE_ADHOC)
		return false;

	return true;
}

/* Change current and default preamble mode.*/
static void rtl_lps_set_psmode(struct ieee80211_hw *hw, u8 rt_psmode)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	u8 rpwm_val, fw_pwrmode;

	if (mac->opmode == NL80211_IFTYPE_ADHOC)
		return;

	if (mac->link_state != MAC80211_LINKED)
		return;

	if (ppsc->dot11_psmode == rt_psmode)
		return;

	/* Update power save mode configured. */
	ppsc->dot11_psmode = rt_psmode;

	/*
	 *<FW control LPS>
	 *1. Enter PS mode
	 *   Set RPWM to Fw to turn RF off and send H2C fw_pwrmode
	 *   cmd to set Fw into PS mode.
	 *2. Leave PS mode
	 *   Send H2C fw_pwrmode cmd to Fw to set Fw into Active
	 *   mode and set RPWM to turn RF on.
	 */

	if ((ppsc->fwctrl_lps) && (ppsc->leisure_ps) &&
	     ppsc->report_linked) {
		bool fw_current_inps;
		if (ppsc->dot11_psmode == EACTIVE) {
			RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
				 ("FW LPS leave ps_mode:%x\n",
				  FW_PS_ACTIVE_MODE));

			rpwm_val = 0x0C;	/* RF on */
			fw_pwrmode = FW_PS_ACTIVE_MODE;
			rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SET_RPWM,
					(u8 *) (&rpwm_val));
			rtlpriv->cfg->ops->set_hw_reg(hw,
					HW_VAR_H2C_FW_PWRMODE,
					(u8 *) (&fw_pwrmode));
			fw_current_inps = false;

			rtlpriv->cfg->ops->set_hw_reg(hw,
					HW_VAR_FW_PSMODE_STATUS,
					(u8 *) (&fw_current_inps));

		} else {
			if (rtl_get_fwlps_doze(hw)) {
				RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
						("FW LPS enter ps_mode:%x\n",
						 ppsc->fwctrl_psmode));

				rpwm_val = 0x02;	/* RF off */
				fw_current_inps = true;
				rtlpriv->cfg->ops->set_hw_reg(hw,
						HW_VAR_FW_PSMODE_STATUS,
						(u8 *) (&fw_current_inps));
				rtlpriv->cfg->ops->set_hw_reg(hw,
						HW_VAR_H2C_FW_PWRMODE,
						(u8 *) (&ppsc->fwctrl_psmode));

				rtlpriv->cfg->ops->set_hw_reg(hw,
						HW_VAR_SET_RPWM,
						(u8 *) (&rpwm_val));
			} else {
				/* Reset the power save related parameters. */
				ppsc->dot11_psmode = EACTIVE;
			}
		}
	}
}

/*Enter the leisure power save mode.*/
void rtl_lps_enter(struct ieee80211_hw *hw)
{
	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	unsigned long flag;

	if (!(ppsc->fwctrl_lps && ppsc->leisure_ps))
		return;

	if (rtlpriv->sec.being_setkey)
		return;

	if (rtlpriv->link_info.busytraffic)
		return;

	/*sleep after linked 10s, to let DHCP and 4-way handshake ok enough!! */
	if (mac->cnt_after_linked < 5)
		return;

	if (mac->opmode == NL80211_IFTYPE_ADHOC)
		return;

	if (mac->link_state != MAC80211_LINKED)
		return;

	spin_lock_irqsave(&rtlpriv->locks.lps_lock, flag);

	if (ppsc->leisure_ps) {
		/* Idle for a while if we connect to AP a while ago. */
		if (mac->cnt_after_linked >= 2) {
			if (ppsc->dot11_psmode == EACTIVE) {
				RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
					("Enter 802.11 power save mode...\n"));

				rtl_lps_set_psmode(hw, EAUTOPS);
			}
		}
	}
	spin_unlock_irqrestore(&rtlpriv->locks.lps_lock, flag);
}

/*Leave the leisure power save mode.*/
void rtl_lps_leave(struct ieee80211_hw *hw)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	unsigned long flag;

	spin_lock_irqsave(&rtlpriv->locks.lps_lock, flag);

	if (ppsc->fwctrl_lps && ppsc->leisure_ps) {
		if (ppsc->dot11_psmode != EACTIVE) {

			/*FIX ME */
			rtlpriv->cfg->ops->enable_interrupt(hw);

			if (ppsc->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM &&
			    RT_IN_PS_LEVEL(ppsc, RT_RF_LPS_LEVEL_ASPM) &&
			    rtlhal->interface == INTF_PCI) {
				rtlpriv->intf_ops->disable_aspm(hw);
				RT_CLEAR_PS_LEVEL(ppsc, RT_RF_LPS_LEVEL_ASPM);
			}

			RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
				 ("Busy Traffic,Leave 802.11 power save..\n"));

			rtl_lps_set_psmode(hw, EACTIVE);
		}
	}
	spin_unlock_irqrestore(&rtlpriv->locks.lps_lock, flag);
}
Commit	Line	Data
0c817338 LF	1	/******************************************************************************
	2	*
	3	* Copyright(c) 2009-2010 Realtek Corporation.
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms of version 2 of the GNU General Public License as
	7	* published by the Free Software Foundation.
	8	*
	9	* This program is distributed in the hope that it will be useful, but WITHOUT
	10	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	11	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	12	* more details.
	13	*
	14	* You should have received a copy of the GNU General Public License along with
	15	* this program; if not, write to the Free Software Foundation, Inc.,
	16	* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
	17	*
	18	* The full GNU General Public License is included in this distribution in the
	19	* file called LICENSE.
	20	*
	21	* Contact Information:
	22	* wlanfae <wlanfae@realtek.com>
	23	* Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
	24	* Hsinchu 300, Taiwan.
	25	*
	26	* Larry Finger <Larry.Finger@lwfinger.net>
	27	*
	28	*****************************************************************************/
	29
	30	#include "wifi.h"
	31	#include "base.h"
	32	#include "ps.h"
	33
	34	bool rtl_ps_enable_nic(struct ieee80211_hw *hw)
	35	{
	36	struct rtl_priv *rtlpriv = rtl_priv(hw);
	37	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	38	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	39	bool init_status = true;
	40
	41	/<1> reset trx ring /
	42	if (rtlhal->interface == INTF_PCI)
	43	rtlpriv->intf_ops->reset_trx_ring(hw);
	44
	45	if (is_hal_stop(rtlhal))
	46	RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
	47	("Driver is already down!\n"));
	48
	49	/<2> Enable Adapter /
	50	rtlpriv->cfg->ops->hw_init(hw);
	51	RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC);
	52	/init_status = false; /
	53
	54	/<3> Enable Interrupt /
	55	rtlpriv->cfg->ops->enable_interrupt(hw);
	56
	57	/<enable timer> /
	58	rtl_watch_dog_timer_callback((unsigned long)hw);
	59
	60	return init_status;
	61	}
	62	EXPORT_SYMBOL(rtl_ps_enable_nic);
	63
	64	bool rtl_ps_disable_nic(struct ieee80211_hw *hw)
65	{
66	bool status = true;
67	struct rtl_priv *rtlpriv = rtl_priv(hw);
68
69	/<1> Stop all timer /
70	rtl_deinit_deferred_work(hw);
71
72	/<2> Disable Interrupt /
73	rtlpriv->cfg->ops->disable_interrupt(hw);
74
75	/<3> Disable Adapter /
76	rtlpriv->cfg->ops->hw_disable(hw);
77
78	return status;
79	}
80	EXPORT_SYMBOL(rtl_ps_disable_nic);
81
82	bool rtl_ps_set_rf_state(struct ieee80211_hw *hw,
83	enum rf_pwrstate state_toset,
84	u32 changesource, bool protect_or_not)
85	{
86	struct rtl_priv *rtlpriv = rtl_priv(hw);
87	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
88	enum rf_pwrstate rtstate;
7ea47240	89	bool actionallowed = false;
0c817338 LF	90	u16 rfwait_cnt = 0;
	91	unsigned long flag;
	92
	93	/protect_or_not = true; /
	94
	95	if (protect_or_not)
	96	goto no_protect;
	97
	98	/*
	99	*Only one thread can change
	100	*the RF state at one time, and others
	101	*should wait to be executed.
	102	*/
	103	while (true) {
	104	spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flag);
	105	if (ppsc->rfchange_inprogress) {
	106	spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock,
	107	flag);
	108
	109	RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
	110	("RF Change in progress!"
	111	"Wait to set..state_toset(%d).\n",
	112	state_toset));
	113
	114	/* Set RF after the previous action is done. */
	115	while (ppsc->rfchange_inprogress) {
	116	rfwait_cnt++;
	117	mdelay(1);
	118
	119	/*
	120	*Wait too long, return false to avoid
	121	*to be stuck here.
	122	*/
	123	if (rfwait_cnt > 100)
	124	return false;
	125	}
	126	} else {
	127	ppsc->rfchange_inprogress = true;
	128	spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock,
	129	flag);
	130	break;
	131	}
	132	}
	133
	134	no_protect:
	135	rtstate = ppsc->rfpwr_state;
	136
	137	switch (state_toset) {
	138	case ERFON:
	139	ppsc->rfoff_reason &= (~changesource);
	140
	141	if ((changesource == RF_CHANGE_BY_HW) &&
7ea47240 LF	142	(ppsc->hwradiooff == true)) {
7ea47240 LF	143	ppsc->hwradiooff = false;
0c817338 LF	144	}
	145
	146	if (!ppsc->rfoff_reason) {
	147	ppsc->rfoff_reason = 0;
7ea47240	148	actionallowed = true;
0c817338 LF	149	}
	150
	151	break;
	152
	153	case ERFOFF:
	154
	155	if ((changesource == RF_CHANGE_BY_HW)
7ea47240 LF	156	&& (ppsc->hwradiooff == false)) {
7ea47240 LF	157	ppsc->hwradiooff = true;
0c817338 LF	158	}
	159
	160	ppsc->rfoff_reason \|= changesource;
7ea47240	161	actionallowed = true;
0c817338 LF	162	break;
	163
	164	case ERFSLEEP:
	165	ppsc->rfoff_reason \|= changesource;
7ea47240	166	actionallowed = true;
0c817338 LF	167	break;
	168
	169	default:
	170	RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
	171	("switch case not process\n"));
	172	break;
	173	}
	174
7ea47240	175	if (actionallowed)
0c817338 LF	176	rtlpriv->cfg->ops->set_rf_power_state(hw, state_toset);
	177
	178	if (!protect_or_not) {
	179	spin_lock_irqsave(&rtlpriv->locks.rf_ps_lock, flag);
	180	ppsc->rfchange_inprogress = false;
	181	spin_unlock_irqrestore(&rtlpriv->locks.rf_ps_lock, flag);
	182	}
	183
7ea47240	184	return actionallowed;
0c817338 LF	185	}
	186	EXPORT_SYMBOL(rtl_ps_set_rf_state);
	187
	188	static void _rtl_ps_inactive_ps(struct ieee80211_hw *hw)
	189	{
	190	struct rtl_priv *rtlpriv = rtl_priv(hw);
	191	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	192	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	193
7ea47240	194	ppsc->swrf_processing = true;
0c817338 LF	195
	196	if (ppsc->inactive_pwrstate == ERFON && rtlhal->interface == INTF_PCI) {
	197	if ((ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM) &&
	198	RT_IN_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_ASPM) &&
	199	rtlhal->interface == INTF_PCI) {
	200	rtlpriv->intf_ops->disable_aspm(hw);
	201	RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_ASPM);
	202	}
	203	}
	204
	205	rtl_ps_set_rf_state(hw, ppsc->inactive_pwrstate,
	206	RF_CHANGE_BY_IPS, false);
	207
	208	if (ppsc->inactive_pwrstate == ERFOFF &&
	209	rtlhal->interface == INTF_PCI) {
	210	if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM) {
	211	rtlpriv->intf_ops->enable_aspm(hw);
	212	RT_SET_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_ASPM);
	213	}
	214	}
	215
7ea47240	216	ppsc->swrf_processing = false;
0c817338 LF	217	}
	218
	219	void rtl_ips_nic_off_wq_callback(void *data)
	220	{
	221	struct rtl_works *rtlworks =
	222	container_of_dwork_rtl(data, struct rtl_works, ips_nic_off_wq);
	223	struct ieee80211_hw *hw = rtlworks->hw;
	224	struct rtl_priv *rtlpriv = rtl_priv(hw);
	225	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	226	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	227	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	228	enum rf_pwrstate rtstate;
	229
	230	if (mac->opmode != NL80211_IFTYPE_STATION) {
	231	RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
	232	("not station return\n"));
	233	return;
	234	}
	235
	236	if (is_hal_stop(rtlhal))
	237	return;
	238
	239	if (rtlpriv->sec.being_setkey)
	240	return;
	241
7ea47240	242	if (ppsc->inactiveps) {
0c817338 LF	243	rtstate = ppsc->rfpwr_state;
	244
	245	/*
	246	*Do not enter IPS in the following conditions:
	247	*(1) RF is already OFF or Sleep
7ea47240	248	*(2) swrf_processing (indicates the IPS is still under going)
0c817338 LF	249	*(3) Connectted (only disconnected can trigger IPS)
	250	*(4) IBSS (send Beacon)
	251	*(5) AP mode (send Beacon)
	252	*(6) monitor mode (rcv packet)
	253	*/
	254
	255	if (rtstate == ERFON &&
7ea47240	256	!ppsc->swrf_processing &&
0c817338 LF	257	(mac->link_state == MAC80211_NOLINK) &&
	258	!mac->act_scanning) {
	259	RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE,
	260	("IPSEnter(): Turn off RF.\n"));
	261
	262	ppsc->inactive_pwrstate = ERFOFF;
7ea47240	263	ppsc->in_powersavemode = true;
0c817338 LF	264
	265	/rtl_pci_reset_trx_ring(hw); /
	266	_rtl_ps_inactive_ps(hw);
	267	}
	268	}
	269	}
	270
	271	void rtl_ips_nic_off(struct ieee80211_hw *hw)
	272	{
	273	struct rtl_priv *rtlpriv = rtl_priv(hw);
	274
	275	/*
	276	*because when link with ap, mac80211 will ask us
	277	*to disable nic quickly after scan before linking,
	278	*this will cause link failed, so we delay 100ms here
	279	*/
	280	queue_delayed_work(rtlpriv->works.rtl_wq,
	281	&rtlpriv->works.ips_nic_off_wq, MSECS(100));
	282	}
	283
	284	void rtl_ips_nic_on(struct ieee80211_hw *hw)
	285	{
	286	struct rtl_priv *rtlpriv = rtl_priv(hw);
	287	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	288	enum rf_pwrstate rtstate;
d704300f	289	unsigned long flags;
0c817338	290
d704300f	291	spin_lock_irqsave(&rtlpriv->locks.ips_lock, flags);
0c817338	292
7ea47240	293	if (ppsc->inactiveps) {
0c817338 LF	294	rtstate = ppsc->rfpwr_state;
	295
	296	if (rtstate != ERFON &&
7ea47240	297	!ppsc->swrf_processing &&
0c817338 LF	298	ppsc->rfoff_reason <= RF_CHANGE_BY_IPS) {
	299
	300	ppsc->inactive_pwrstate = ERFON;
7ea47240	301	ppsc->in_powersavemode = false;
0c817338 LF	302
	303	_rtl_ps_inactive_ps(hw);
	304	}
	305	}
	306
d704300f	307	spin_unlock_irqrestore(&rtlpriv->locks.ips_lock, flags);
0c817338 LF	308	}
	309
	310	/for FW LPS/
	311
	312	/*
	313	*Determine if we can set Fw into PS mode
	314	*in current condition.Return TRUE if it
	315	*can enter PS mode.
	316	*/
	317	static bool rtl_get_fwlps_doze(struct ieee80211_hw *hw)
	318	{
	319	struct rtl_priv *rtlpriv = rtl_priv(hw);
	320	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	321	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	322	u32 ps_timediff;
	323
	324	ps_timediff = jiffies_to_msecs(jiffies -
	325	ppsc->last_delaylps_stamp_jiffies);
	326
	327	if (ps_timediff < 2000) {
	328	RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
	329	("Delay enter Fw LPS for DHCP, ARP,"
	330	" or EAPOL exchanging state.\n"));
	331	return false;
	332	}
	333
	334	if (mac->link_state != MAC80211_LINKED)
	335	return false;
	336
	337	if (mac->opmode == NL80211_IFTYPE_ADHOC)
	338	return false;
	339
	340	return true;
	341	}
	342
	343	/* Change current and default preamble mode.*/
	344	static void rtl_lps_set_psmode(struct ieee80211_hw *hw, u8 rt_psmode)
	345	{
	346	struct rtl_priv *rtlpriv = rtl_priv(hw);
	347	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	348	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	349	u8 rpwm_val, fw_pwrmode;
	350
	351	if (mac->opmode == NL80211_IFTYPE_ADHOC)
	352	return;
	353
	354	if (mac->link_state != MAC80211_LINKED)
	355	return;
	356
	357	if (ppsc->dot11_psmode == rt_psmode)
	358	return;
	359
	360	/* Update power save mode configured. */
	361	ppsc->dot11_psmode = rt_psmode;
	362
	363	/*
	364	*<FW control LPS>
	365	*1. Enter PS mode
	366	* Set RPWM to Fw to turn RF off and send H2C fw_pwrmode
	367	* cmd to set Fw into PS mode.
	368	*2. Leave PS mode
	369	* Send H2C fw_pwrmode cmd to Fw to set Fw into Active
	370	* mode and set RPWM to turn RF on.
	371	*/
372
7ea47240	373	if ((ppsc->fwctrl_lps) && (ppsc->leisure_ps) &&
0c817338	374	ppsc->report_linked) {
7ea47240	375	bool fw_current_inps;
0c817338 LF	376	if (ppsc->dot11_psmode == EACTIVE) {
	377	RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
	378	("FW LPS leave ps_mode:%x\n",
	379	FW_PS_ACTIVE_MODE));
	380
	381	rpwm_val = 0x0C; /* RF on */
	382	fw_pwrmode = FW_PS_ACTIVE_MODE;
	383	rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SET_RPWM,
	384	(u8 *) (&rpwm_val));
	385	rtlpriv->cfg->ops->set_hw_reg(hw,
	386	HW_VAR_H2C_FW_PWRMODE,
	387	(u8 *) (&fw_pwrmode));
7ea47240	388	fw_current_inps = false;
0c817338 LF	389
	390	rtlpriv->cfg->ops->set_hw_reg(hw,
	391	HW_VAR_FW_PSMODE_STATUS,
7ea47240	392	(u8 *) (&fw_current_inps));
0c817338 LF	393
	394	} else {
	395	if (rtl_get_fwlps_doze(hw)) {
	396	RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
	397	("FW LPS enter ps_mode:%x\n",
	398	ppsc->fwctrl_psmode));
	399
	400	rpwm_val = 0x02; /* RF off */
7ea47240	401	fw_current_inps = true;
0c817338 LF	402	rtlpriv->cfg->ops->set_hw_reg(hw,
0c817338 LF	403	HW_VAR_FW_PSMODE_STATUS,
7ea47240	404	(u8 *) (&fw_current_inps));
0c817338 LF	405	rtlpriv->cfg->ops->set_hw_reg(hw,
	406	HW_VAR_H2C_FW_PWRMODE,
	407	(u8 *) (&ppsc->fwctrl_psmode));
	408
	409	rtlpriv->cfg->ops->set_hw_reg(hw,
	410	HW_VAR_SET_RPWM,
	411	(u8 *) (&rpwm_val));
	412	} else {
	413	/* Reset the power save related parameters. */
	414	ppsc->dot11_psmode = EACTIVE;
	415	}
	416	}
	417	}
	418	}
	419
	420	/Enter the leisure power save mode./
	421	void rtl_lps_enter(struct ieee80211_hw *hw)
	422	{
	423	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	424	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	425	struct rtl_priv *rtlpriv = rtl_priv(hw);
	426	unsigned long flag;
	427
7ea47240	428	if (!(ppsc->fwctrl_lps && ppsc->leisure_ps))
0c817338 LF	429	return;
	430
	431	if (rtlpriv->sec.being_setkey)
	432	return;
	433
7ea47240	434	if (rtlpriv->link_info.busytraffic)
0c817338 LF	435	return;
	436
	437	/sleep after linked 10s, to let DHCP and 4-way handshake ok enough!! /
	438	if (mac->cnt_after_linked < 5)
	439	return;
	440
	441	if (mac->opmode == NL80211_IFTYPE_ADHOC)
	442	return;
	443
	444	if (mac->link_state != MAC80211_LINKED)
	445	return;
	446
	447	spin_lock_irqsave(&rtlpriv->locks.lps_lock, flag);
	448
7ea47240	449	if (ppsc->leisure_ps) {
0c817338 LF	450	/* Idle for a while if we connect to AP a while ago. */
	451	if (mac->cnt_after_linked >= 2) {
	452	if (ppsc->dot11_psmode == EACTIVE) {
	453	RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
	454	("Enter 802.11 power save mode...\n"));
	455
	456	rtl_lps_set_psmode(hw, EAUTOPS);
	457	}
	458	}
	459	}
	460	spin_unlock_irqrestore(&rtlpriv->locks.lps_lock, flag);
	461	}
	462
	463	/Leave the leisure power save mode./
	464	void rtl_lps_leave(struct ieee80211_hw *hw)
	465	{
	466	struct rtl_priv *rtlpriv = rtl_priv(hw);
	467	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	468	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	469	unsigned long flag;
	470
	471	spin_lock_irqsave(&rtlpriv->locks.lps_lock, flag);
	472
7ea47240	473	if (ppsc->fwctrl_lps && ppsc->leisure_ps) {
0c817338 LF	474	if (ppsc->dot11_psmode != EACTIVE) {
	475
	476	/FIX ME /
	477	rtlpriv->cfg->ops->enable_interrupt(hw);
	478
	479	if (ppsc->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM &&
	480	RT_IN_PS_LEVEL(ppsc, RT_RF_LPS_LEVEL_ASPM) &&
	481	rtlhal->interface == INTF_PCI) {
	482	rtlpriv->intf_ops->disable_aspm(hw);
	483	RT_CLEAR_PS_LEVEL(ppsc, RT_RF_LPS_LEVEL_ASPM);
	484	}
	485
	486	RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
	487	("Busy Traffic,Leave 802.11 power save..\n"));
	488
	489	rtl_lps_set_psmode(hw, EACTIVE);
	490	}
	491	}
	492	spin_unlock_irqrestore(&rtlpriv->locks.lps_lock, flag);
	493	}