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

/******************************************************************************
 *
 * Copyright(c) 2009-2012  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 <linux/export.h>
#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));

	/*<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 */
	if (rtlpriv->cfg->ops->hw_init(hw))
		return 1;
	RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC);

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

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

	return true;
}
EXPORT_SYMBOL(rtl_ps_enable_nic);

bool rtl_ps_disable_nic(struct ieee80211_hw *hw)
{
	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);
	tasklet_kill(&rtlpriv->works.irq_tasklet);

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

	return true;
}
EXPORT_SYMBOL(rtl_ps_disable_nic);

bool rtl_ps_set_rf_state(struct ieee80211_hw *hw,
			 enum rf_pwrstate state_toset,
			 u32 changesource)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	bool actionallowed = false;

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

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

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

		break;

	case ERFOFF:

		if ((changesource == RF_CHANGE_BY_HW) && !ppsc->hwradiooff) {
			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 processed\n");
		break;
	}

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

	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_PS_LEVEL_ASPM) &&
		    rtlhal->interface == INTF_PCI) {
			rtlpriv->intf_ops->disable_aspm(hw);
			RT_CLEAR_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
		}
	}

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

	if (ppsc->inactive_pwrstate == ERFOFF &&
	    rtlhal->interface == INTF_PCI) {
		if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM &&
			!RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM)) {
			rtlpriv->intf_ops->enable_aspm(hw);
			RT_SET_PS_LEVEL(ppsc, RT_PS_LEVEL_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 (mac->link_state > MAC80211_NOLINK)
		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_mac *mac = rtl_mac(rtl_priv(hw));
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	enum rf_pwrstate rtstate;
	unsigned long flags;

	if (mac->opmode != NL80211_IFTYPE_STATION)
		return;

	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->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);

	if (!ppsc->fwctrl_lps)
		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;

	mutex_lock(&rtlpriv->locks.ps_mutex);

	/* 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);
		}
	}

	mutex_unlock(&rtlpriv->locks.ps_mutex);
}

/*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));

	mutex_lock(&rtlpriv->locks.ps_mutex);

	if (ppsc->fwctrl_lps) {
		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_PS_LEVEL_ASPM) &&
			    rtlhal->interface == INTF_PCI) {
				rtlpriv->intf_ops->disable_aspm(hw);
				RT_CLEAR_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
			}

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

			rtl_lps_set_psmode(hw, EACTIVE);
		}
	}
	mutex_unlock(&rtlpriv->locks.ps_mutex);
}

/* For sw LPS*/
void rtl_swlps_beacon(struct ieee80211_hw *hw, void *data, unsigned int len)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	struct ieee80211_hdr *hdr = (void *) data;
	struct ieee80211_tim_ie *tim_ie;
	u8 *tim;
	u8 tim_len;
	bool u_buffed;
	bool m_buffed;

	if (mac->opmode != NL80211_IFTYPE_STATION)
		return;

	if (!rtlpriv->psc.swctrl_lps)
		return;

	if (rtlpriv->mac80211.link_state != MAC80211_LINKED)
		return;

	if (!rtlpriv->psc.sw_ps_enabled)
		return;

	if (rtlpriv->psc.fwctrl_lps)
		return;

	if (likely(!(hw->conf.flags & IEEE80211_CONF_PS)))
		return;

	/* check if this really is a beacon */
	if (!ieee80211_is_beacon(hdr->frame_control))
		return;

	/* min. beacon length + FCS_LEN */
	if (len <= 40 + FCS_LEN)
		return;

	/* and only beacons from the associated BSSID, please */
	if (compare_ether_addr(hdr->addr3, rtlpriv->mac80211.bssid))
		return;

	rtlpriv->psc.last_beacon = jiffies;

	tim = rtl_find_ie(data, len - FCS_LEN, WLAN_EID_TIM);
	if (!tim)
		return;

	if (tim[1] < sizeof(*tim_ie))
		return;

	tim_len = tim[1];
	tim_ie = (struct ieee80211_tim_ie *) &tim[2];

	if (!WARN_ON_ONCE(!hw->conf.ps_dtim_period))
		rtlpriv->psc.dtim_counter = tim_ie->dtim_count;

	/* Check whenever the PHY can be turned off again. */

	/* 1. What about buffered unicast traffic for our AID? */
	u_buffed = ieee80211_check_tim(tim_ie, tim_len,
				       rtlpriv->mac80211.assoc_id);

	/* 2. Maybe the AP wants to send multicast/broadcast data? */
	m_buffed = tim_ie->bitmap_ctrl & 0x01;
	rtlpriv->psc.multi_buffered = m_buffed;

	/* unicast will process by mac80211 through
	 * set ~IEEE80211_CONF_PS, So we just check
	 * multicast frames here */
	if (!m_buffed) {
		/* back to low-power land. and delay is
		 * prevent null power save frame tx fail */
		queue_delayed_work(rtlpriv->works.rtl_wq,
				&rtlpriv->works.ps_work, MSECS(5));
	} else {
		RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
			 "u_bufferd: %x, m_buffered: %x\n", u_buffed, m_buffed);
	}
}

void rtl_swlps_rf_awake(struct ieee80211_hw *hw)
{
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));

	if (!rtlpriv->psc.swctrl_lps)
		return;
	if (mac->link_state != MAC80211_LINKED)
		return;

	if (ppsc->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM &&
		RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM)) {
		rtlpriv->intf_ops->disable_aspm(hw);
		RT_CLEAR_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
	}

	mutex_lock(&rtlpriv->locks.ps_mutex);
	rtl_ps_set_rf_state(hw, ERFON, RF_CHANGE_BY_PS);
	mutex_unlock(&rtlpriv->locks.ps_mutex);
}

void rtl_swlps_rfon_wq_callback(void *data)
{
	struct rtl_works *rtlworks =
	    container_of_dwork_rtl(data, struct rtl_works, ps_rfon_wq);
	struct ieee80211_hw *hw = rtlworks->hw;

	rtl_swlps_rf_awake(hw);
}

void rtl_swlps_rf_sleep(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));
	u8 sleep_intv;

	if (!rtlpriv->psc.sw_ps_enabled)
		return;

	if ((rtlpriv->sec.being_setkey) ||
	    (mac->opmode == NL80211_IFTYPE_ADHOC))
		return;

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

	if (rtlpriv->link_info.busytraffic)
		return;

	mutex_lock(&rtlpriv->locks.ps_mutex);
	rtl_ps_set_rf_state(hw, ERFSLEEP, RF_CHANGE_BY_PS);
	mutex_unlock(&rtlpriv->locks.ps_mutex);

	if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM &&
		!RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM)) {
		rtlpriv->intf_ops->enable_aspm(hw);
		RT_SET_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
	}

	/* here is power save alg, when this beacon is DTIM
	 * we will set sleep time to dtim_period * n;
	 * when this beacon is not DTIM, we will set sleep
	 * time to sleep_intv = rtlpriv->psc.dtim_counter or
	 * MAX_SW_LPS_SLEEP_INTV(default set to 5) */

	if (rtlpriv->psc.dtim_counter == 0) {
		if (hw->conf.ps_dtim_period == 1)
			sleep_intv = hw->conf.ps_dtim_period * 2;
		else
			sleep_intv = hw->conf.ps_dtim_period;
	} else {
		sleep_intv = rtlpriv->psc.dtim_counter;
	}

	if (sleep_intv > MAX_SW_LPS_SLEEP_INTV)
		sleep_intv = MAX_SW_LPS_SLEEP_INTV;

	/* this print should always be dtim_conter = 0 &
	 * sleep  = dtim_period, that meaons, we should
	 * awake before every dtim */
	RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
		 "dtim_counter:%x will sleep :%d beacon_intv\n",
		 rtlpriv->psc.dtim_counter, sleep_intv);

	/* we tested that 40ms is enough for sw & hw sw delay */
	queue_delayed_work(rtlpriv->works.rtl_wq, &rtlpriv->works.ps_rfon_wq,
			MSECS(sleep_intv * mac->vif->bss_conf.beacon_int - 40));
}


void rtl_swlps_wq_callback(void *data)
{
	struct rtl_works *rtlworks = container_of_dwork_rtl(data,
				     struct rtl_works,
				     ps_work);
	struct ieee80211_hw *hw = rtlworks->hw;
	struct rtl_priv *rtlpriv = rtl_priv(hw);
	bool ps = false;

	ps = (hw->conf.flags & IEEE80211_CONF_PS);

	/* we can sleep after ps null send ok */
	if (rtlpriv->psc.state_inap) {
		rtl_swlps_rf_sleep(hw);

		if (rtlpriv->psc.state && !ps) {
			rtlpriv->psc.sleep_ms = jiffies_to_msecs(jiffies -
					rtlpriv->psc.last_action);
		}

		if (ps)
			rtlpriv->psc.last_slept = jiffies;

		rtlpriv->psc.last_action = jiffies;
		rtlpriv->psc.state = ps;
	}
}
Commit	Line	Data
0c817338 LF	1	/******************************************************************************
0c817338 LF	2	*
a8d76066	3	* Copyright(c) 2009-2012 Realtek Corporation.
0c817338 LF	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
ee40fa06	30	#include <linux/export.h>
0c817338 LF	31	#include "wifi.h"
	32	#include "base.h"
	33	#include "ps.h"
	34
	35	bool rtl_ps_enable_nic(struct ieee80211_hw *hw)
	36	{
	37	struct rtl_priv *rtlpriv = rtl_priv(hw);
	38	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	39	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
0c817338 LF	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,
f30d7507	47	"Driver is already down!\n");
0c817338 LF	48
0c817338 LF	49	/<2> Enable Adapter /
b0302aba LF	50	if (rtlpriv->cfg->ops->hw_init(hw))
b0302aba LF	51	return 1;
0c817338	52	RT_CLEAR_PS_LEVEL(ppsc, RT_RF_OFF_LEVL_HALT_NIC);
0c817338 LF	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
cc7dc0c4	60	return true;
0c817338 LF	61	}
	62	EXPORT_SYMBOL(rtl_ps_enable_nic);
	63
	64	bool rtl_ps_disable_nic(struct ieee80211_hw *hw)
	65	{
0c817338 LF	66	struct rtl_priv *rtlpriv = rtl_priv(hw);
	67
	68	/<1> Stop all timer /
	69	rtl_deinit_deferred_work(hw);
	70
	71	/<2> Disable Interrupt /
	72	rtlpriv->cfg->ops->disable_interrupt(hw);
67fc6052	73	tasklet_kill(&rtlpriv->works.irq_tasklet);
0c817338 LF	74
	75	/<3> Disable Adapter /
	76	rtlpriv->cfg->ops->hw_disable(hw);
	77
32473284	78	return true;
0c817338 LF	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,
4b9d8d67	84	u32 changesource)
0c817338 LF	85	{
	86	struct rtl_priv *rtlpriv = rtl_priv(hw);
	87	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
7ea47240	88	bool actionallowed = false;
0c817338	89
0c817338 LF	90	switch (state_toset) {
	91	case ERFON:
	92	ppsc->rfoff_reason &= (~changesource);
	93
	94	if ((changesource == RF_CHANGE_BY_HW) &&
e10542c4	95	(ppsc->hwradiooff)) {
7ea47240	96	ppsc->hwradiooff = false;
0c817338 LF	97	}
	98
	99	if (!ppsc->rfoff_reason) {
	100	ppsc->rfoff_reason = 0;
7ea47240	101	actionallowed = true;
0c817338 LF	102	}
	103
	104	break;
	105
	106	case ERFOFF:
	107
23677ce3	108	if ((changesource == RF_CHANGE_BY_HW) && !ppsc->hwradiooff) {
7ea47240	109	ppsc->hwradiooff = true;
0c817338 LF	110	}
	111
	112	ppsc->rfoff_reason \|= changesource;
7ea47240	113	actionallowed = true;
0c817338 LF	114	break;
	115
	116	case ERFSLEEP:
	117	ppsc->rfoff_reason \|= changesource;
7ea47240	118	actionallowed = true;
0c817338 LF	119	break;
	120
	121	default:
	122	RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
f30d7507	123	"switch case not processed\n");
0c817338 LF	124	break;
	125	}
	126
7ea47240	127	if (actionallowed)
0c817338 LF	128	rtlpriv->cfg->ops->set_rf_power_state(hw, state_toset);
0c817338 LF	129
7ea47240	130	return actionallowed;
0c817338 LF	131	}
	132	EXPORT_SYMBOL(rtl_ps_set_rf_state);
	133
	134	static void _rtl_ps_inactive_ps(struct ieee80211_hw *hw)
	135	{
	136	struct rtl_priv *rtlpriv = rtl_priv(hw);
	137	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	138	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	139
7ea47240	140	ppsc->swrf_processing = true;
0c817338	141
099fb8ab	142	if (ppsc->inactive_pwrstate == ERFON &&
cc7dc0c4	143	rtlhal->interface == INTF_PCI) {
0c817338	144	if ((ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM) &&
cc7dc0c4	145	RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM) &&
0c817338 LF	146	rtlhal->interface == INTF_PCI) {
0c817338 LF	147	rtlpriv->intf_ops->disable_aspm(hw);
cc7dc0c4	148	RT_CLEAR_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
0c817338 LF	149	}
	150	}
	151
4b9d8d67	152	rtl_ps_set_rf_state(hw, ppsc->inactive_pwrstate, RF_CHANGE_BY_IPS);
0c817338 LF	153
	154	if (ppsc->inactive_pwrstate == ERFOFF &&
	155	rtlhal->interface == INTF_PCI) {
cc7dc0c4 C	156	if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM &&
cc7dc0c4 C	157	!RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM)) {
0c817338	158	rtlpriv->intf_ops->enable_aspm(hw);
cc7dc0c4	159	RT_SET_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
0c817338 LF	160	}
	161	}
	162
7ea47240	163	ppsc->swrf_processing = false;
0c817338 LF	164	}
	165
	166	void rtl_ips_nic_off_wq_callback(void *data)
	167	{
	168	struct rtl_works *rtlworks =
	169	container_of_dwork_rtl(data, struct rtl_works, ips_nic_off_wq);
	170	struct ieee80211_hw *hw = rtlworks->hw;
	171	struct rtl_priv *rtlpriv = rtl_priv(hw);
	172	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
	173	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	174	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	175	enum rf_pwrstate rtstate;
	176
	177	if (mac->opmode != NL80211_IFTYPE_STATION) {
	178	RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
f30d7507	179	"not station return\n");
0c817338 LF	180	return;
	181	}
	182
cc7dc0c4 C	183	if (mac->link_state > MAC80211_NOLINK)
	184	return;
	185
0c817338 LF	186	if (is_hal_stop(rtlhal))
	187	return;
	188
	189	if (rtlpriv->sec.being_setkey)
	190	return;
	191
7ea47240	192	if (ppsc->inactiveps) {
0c817338 LF	193	rtstate = ppsc->rfpwr_state;
	194
	195	/*
	196	*Do not enter IPS in the following conditions:
	197	*(1) RF is already OFF or Sleep
7ea47240	198	*(2) swrf_processing (indicates the IPS is still under going)
0c817338 LF	199	*(3) Connectted (only disconnected can trigger IPS)
	200	*(4) IBSS (send Beacon)
	201	*(5) AP mode (send Beacon)
	202	*(6) monitor mode (rcv packet)
	203	*/
	204
	205	if (rtstate == ERFON &&
7ea47240	206	!ppsc->swrf_processing &&
0c817338 LF	207	(mac->link_state == MAC80211_NOLINK) &&
	208	!mac->act_scanning) {
	209	RT_TRACE(rtlpriv, COMP_RF, DBG_TRACE,
f30d7507	210	"IPSEnter(): Turn off RF\n");
0c817338 LF	211
0c817338 LF	212	ppsc->inactive_pwrstate = ERFOFF;
7ea47240	213	ppsc->in_powersavemode = true;
0c817338 LF	214
	215	/rtl_pci_reset_trx_ring(hw); /
	216	_rtl_ps_inactive_ps(hw);
	217	}
	218	}
	219	}
	220
	221	void rtl_ips_nic_off(struct ieee80211_hw *hw)
	222	{
	223	struct rtl_priv *rtlpriv = rtl_priv(hw);
	224
	225	/*
	226	*because when link with ap, mac80211 will ask us
	227	*to disable nic quickly after scan before linking,
	228	*this will cause link failed, so we delay 100ms here
	229	*/
	230	queue_delayed_work(rtlpriv->works.rtl_wq,
	231	&rtlpriv->works.ips_nic_off_wq, MSECS(100));
	232	}
	233
	234	void rtl_ips_nic_on(struct ieee80211_hw *hw)
	235	{
	236	struct rtl_priv *rtlpriv = rtl_priv(hw);
cc7dc0c4	237	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
0c817338 LF	238	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
0c817338 LF	239	enum rf_pwrstate rtstate;
b9116b9a	240	unsigned long flags;
0c817338	241
cc7dc0c4 C	242	if (mac->opmode != NL80211_IFTYPE_STATION)
	243	return;
	244
b9116b9a	245	spin_lock_irqsave(&rtlpriv->locks.ips_lock, flags);
0c817338	246
7ea47240	247	if (ppsc->inactiveps) {
0c817338 LF	248	rtstate = ppsc->rfpwr_state;
	249
	250	if (rtstate != ERFON &&
7ea47240	251	!ppsc->swrf_processing &&
0c817338 LF	252	ppsc->rfoff_reason <= RF_CHANGE_BY_IPS) {
	253
	254	ppsc->inactive_pwrstate = ERFON;
7ea47240	255	ppsc->in_powersavemode = false;
0c817338 LF	256
	257	_rtl_ps_inactive_ps(hw);
	258	}
	259	}
	260
b9116b9a	261	spin_unlock_irqrestore(&rtlpriv->locks.ips_lock, flags);
0c817338 LF	262	}
	263
	264	/for FW LPS/
	265
	266	/*
	267	*Determine if we can set Fw into PS mode
	268	*in current condition.Return TRUE if it
	269	*can enter PS mode.
	270	*/
	271	static bool rtl_get_fwlps_doze(struct ieee80211_hw *hw)
	272	{
	273	struct rtl_priv *rtlpriv = rtl_priv(hw);
	274	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	275	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	276	u32 ps_timediff;
	277
	278	ps_timediff = jiffies_to_msecs(jiffies -
	279	ppsc->last_delaylps_stamp_jiffies);
	280
	281	if (ps_timediff < 2000) {
	282	RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
f30d7507	283	"Delay enter Fw LPS for DHCP, ARP, or EAPOL exchanging state\n");
0c817338 LF	284	return false;
	285	}
	286
	287	if (mac->link_state != MAC80211_LINKED)
	288	return false;
	289
	290	if (mac->opmode == NL80211_IFTYPE_ADHOC)
	291	return false;
	292
	293	return true;
	294	}
	295
	296	/* Change current and default preamble mode.*/
	297	static void rtl_lps_set_psmode(struct ieee80211_hw *hw, u8 rt_psmode)
	298	{
	299	struct rtl_priv *rtlpriv = rtl_priv(hw);
	300	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	301	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	302	u8 rpwm_val, fw_pwrmode;
	303
	304	if (mac->opmode == NL80211_IFTYPE_ADHOC)
	305	return;
	306
	307	if (mac->link_state != MAC80211_LINKED)
	308	return;
	309
	310	if (ppsc->dot11_psmode == rt_psmode)
	311	return;
	312
	313	/* Update power save mode configured. */
	314	ppsc->dot11_psmode = rt_psmode;
	315
	316	/*
	317	*<FW control LPS>
	318	*1. Enter PS mode
	319	* Set RPWM to Fw to turn RF off and send H2C fw_pwrmode
	320	* cmd to set Fw into PS mode.
	321	*2. Leave PS mode
	322	* Send H2C fw_pwrmode cmd to Fw to set Fw into Active
	323	* mode and set RPWM to turn RF on.
	324	*/
	325
cc7dc0c4	326	if ((ppsc->fwctrl_lps) && ppsc->report_linked) {
7ea47240	327	bool fw_current_inps;
0c817338 LF	328	if (ppsc->dot11_psmode == EACTIVE) {
0c817338 LF	329	RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
f30d7507 JP	330	"FW LPS leave ps_mode:%x\n",
f30d7507 JP	331	FW_PS_ACTIVE_MODE);
0c817338 LF	332
	333	rpwm_val = 0x0C; /* RF on */
	334	fw_pwrmode = FW_PS_ACTIVE_MODE;
	335	rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SET_RPWM,
	336	(u8 *) (&rpwm_val));
	337	rtlpriv->cfg->ops->set_hw_reg(hw,
	338	HW_VAR_H2C_FW_PWRMODE,
	339	(u8 *) (&fw_pwrmode));
7ea47240	340	fw_current_inps = false;
0c817338 LF	341
	342	rtlpriv->cfg->ops->set_hw_reg(hw,
	343	HW_VAR_FW_PSMODE_STATUS,
7ea47240	344	(u8 *) (&fw_current_inps));
0c817338 LF	345
	346	} else {
	347	if (rtl_get_fwlps_doze(hw)) {
	348	RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
f30d7507 JP	349	"FW LPS enter ps_mode:%x\n",
f30d7507 JP	350	ppsc->fwctrl_psmode);
0c817338 LF	351
0c817338 LF	352	rpwm_val = 0x02; /* RF off */
7ea47240	353	fw_current_inps = true;
0c817338 LF	354	rtlpriv->cfg->ops->set_hw_reg(hw,
0c817338 LF	355	HW_VAR_FW_PSMODE_STATUS,
7ea47240	356	(u8 *) (&fw_current_inps));
0c817338 LF	357	rtlpriv->cfg->ops->set_hw_reg(hw,
	358	HW_VAR_H2C_FW_PWRMODE,
	359	(u8 *) (&ppsc->fwctrl_psmode));
	360
	361	rtlpriv->cfg->ops->set_hw_reg(hw,
	362	HW_VAR_SET_RPWM,
	363	(u8 *) (&rpwm_val));
	364	} else {
	365	/* Reset the power save related parameters. */
	366	ppsc->dot11_psmode = EACTIVE;
	367	}
	368	}
	369	}
	370	}
	371
	372	/Enter the leisure power save mode./
	373	void rtl_lps_enter(struct ieee80211_hw *hw)
	374	{
	375	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	376	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	377	struct rtl_priv *rtlpriv = rtl_priv(hw);
0c817338	378
cc7dc0c4	379	if (!ppsc->fwctrl_lps)
0c817338 LF	380	return;
	381
	382	if (rtlpriv->sec.being_setkey)
	383	return;
	384
7ea47240	385	if (rtlpriv->link_info.busytraffic)
0c817338 LF	386	return;
	387
	388	/sleep after linked 10s, to let DHCP and 4-way handshake ok enough!! /
	389	if (mac->cnt_after_linked < 5)
	390	return;
	391
	392	if (mac->opmode == NL80211_IFTYPE_ADHOC)
	393	return;
	394
	395	if (mac->link_state != MAC80211_LINKED)
	396	return;
	397
6539306b	398	mutex_lock(&rtlpriv->locks.ps_mutex);
0c817338	399
cc7dc0c4 C	400	/* Idle for a while if we connect to AP a while ago. */
	401	if (mac->cnt_after_linked >= 2) {
	402	if (ppsc->dot11_psmode == EACTIVE) {
	403	RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
f30d7507	404	"Enter 802.11 power save mode...\n");
0c817338	405
cc7dc0c4	406	rtl_lps_set_psmode(hw, EAUTOPS);
0c817338 LF	407	}
0c817338 LF	408	}
cc7dc0c4	409
6539306b	410	mutex_unlock(&rtlpriv->locks.ps_mutex);
0c817338 LF	411	}
	412
	413	/Leave the leisure power save mode./
	414	void rtl_lps_leave(struct ieee80211_hw *hw)
	415	{
	416	struct rtl_priv *rtlpriv = rtl_priv(hw);
	417	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	418	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
0c817338	419
6539306b	420	mutex_lock(&rtlpriv->locks.ps_mutex);
0c817338	421
cc7dc0c4	422	if (ppsc->fwctrl_lps) {
0c817338 LF	423	if (ppsc->dot11_psmode != EACTIVE) {
	424
	425	/FIX ME /
	426	rtlpriv->cfg->ops->enable_interrupt(hw);
	427
	428	if (ppsc->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM &&
cc7dc0c4	429	RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM) &&
0c817338 LF	430	rtlhal->interface == INTF_PCI) {
0c817338 LF	431	rtlpriv->intf_ops->disable_aspm(hw);
cc7dc0c4	432	RT_CLEAR_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
0c817338 LF	433	}
	434
	435	RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
f30d7507	436	"Busy Traffic,Leave 802.11 power save..\n");
0c817338 LF	437
	438	rtl_lps_set_psmode(hw, EACTIVE);
	439	}
	440	}
6539306b	441	mutex_unlock(&rtlpriv->locks.ps_mutex);
0c817338	442	}
cc7dc0c4 C	443
	444	/* For sw LPS*/
	445	void rtl_swlps_beacon(struct ieee80211_hw hw, void data, unsigned int len)
	446	{
	447	struct rtl_priv *rtlpriv = rtl_priv(hw);
	448	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	449	struct ieee80211_hdr hdr = (void ) data;
	450	struct ieee80211_tim_ie *tim_ie;
	451	u8 *tim;
	452	u8 tim_len;
	453	bool u_buffed;
	454	bool m_buffed;
	455
	456	if (mac->opmode != NL80211_IFTYPE_STATION)
	457	return;
	458
	459	if (!rtlpriv->psc.swctrl_lps)
	460	return;
	461
	462	if (rtlpriv->mac80211.link_state != MAC80211_LINKED)
	463	return;
	464
	465	if (!rtlpriv->psc.sw_ps_enabled)
	466	return;
	467
	468	if (rtlpriv->psc.fwctrl_lps)
	469	return;
	470
	471	if (likely(!(hw->conf.flags & IEEE80211_CONF_PS)))
	472	return;
	473
	474	/* check if this really is a beacon */
	475	if (!ieee80211_is_beacon(hdr->frame_control))
	476	return;
	477
	478	/* min. beacon length + FCS_LEN */
	479	if (len <= 40 + FCS_LEN)
	480	return;
	481
	482	/* and only beacons from the associated BSSID, please */
	483	if (compare_ether_addr(hdr->addr3, rtlpriv->mac80211.bssid))
	484	return;
	485
	486	rtlpriv->psc.last_beacon = jiffies;
	487
	488	tim = rtl_find_ie(data, len - FCS_LEN, WLAN_EID_TIM);
	489	if (!tim)
	490	return;
	491
	492	if (tim[1] < sizeof(*tim_ie))
	493	return;
	494
	495	tim_len = tim[1];
	496	tim_ie = (struct ieee80211_tim_ie *) &tim[2];
	497
	498	if (!WARN_ON_ONCE(!hw->conf.ps_dtim_period))
	499	rtlpriv->psc.dtim_counter = tim_ie->dtim_count;
	500
	501	/* Check whenever the PHY can be turned off again. */
	502
	503	/* 1. What about buffered unicast traffic for our AID? */
	504	u_buffed = ieee80211_check_tim(tim_ie, tim_len,
	505	rtlpriv->mac80211.assoc_id);
	506
507	/* 2. Maybe the AP wants to send multicast/broadcast data? */
508	m_buffed = tim_ie->bitmap_ctrl & 0x01;
509	rtlpriv->psc.multi_buffered = m_buffed;
510
511	/* unicast will process by mac80211 through
512	* set ~IEEE80211_CONF_PS, So we just check
513	* multicast frames here */
514	if (!m_buffed) {
515	/* back to low-power land. and delay is
516	* prevent null power save frame tx fail */
517	queue_delayed_work(rtlpriv->works.rtl_wq,
518	&rtlpriv->works.ps_work, MSECS(5));
519	} else {
f30d7507 JP	520	RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
f30d7507 JP	521	"u_bufferd: %x, m_buffered: %x\n", u_buffed, m_buffed);
cc7dc0c4 C	522	}
	523	}
	524
	525	void rtl_swlps_rf_awake(struct ieee80211_hw *hw)
	526	{
	527	struct rtl_priv *rtlpriv = rtl_priv(hw);
	528	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
	529	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
cc7dc0c4 C	530
	531	if (!rtlpriv->psc.swctrl_lps)
	532	return;
	533	if (mac->link_state != MAC80211_LINKED)
	534	return;
	535
	536	if (ppsc->reg_rfps_level & RT_RF_LPS_LEVEL_ASPM &&
	537	RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM)) {
	538	rtlpriv->intf_ops->disable_aspm(hw);
	539	RT_CLEAR_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
	540	}
	541
6539306b	542	mutex_lock(&rtlpriv->locks.ps_mutex);
4b9d8d67	543	rtl_ps_set_rf_state(hw, ERFON, RF_CHANGE_BY_PS);
6539306b	544	mutex_unlock(&rtlpriv->locks.ps_mutex);
cc7dc0c4 C	545	}
	546
	547	void rtl_swlps_rfon_wq_callback(void *data)
	548	{
	549	struct rtl_works *rtlworks =
	550	container_of_dwork_rtl(data, struct rtl_works, ps_rfon_wq);
	551	struct ieee80211_hw *hw = rtlworks->hw;
	552
	553	rtl_swlps_rf_awake(hw);
	554	}
	555
	556	void rtl_swlps_rf_sleep(struct ieee80211_hw *hw)
	557	{
	558	struct rtl_priv *rtlpriv = rtl_priv(hw);
	559	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
	560	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
cc7dc0c4 C	561	u8 sleep_intv;
	562
	563	if (!rtlpriv->psc.sw_ps_enabled)
	564	return;
	565
	566	if ((rtlpriv->sec.being_setkey) \|\|
	567	(mac->opmode == NL80211_IFTYPE_ADHOC))
	568	return;
	569
	570	/sleep after linked 10s, to let DHCP and 4-way handshake ok enough!! /
	571	if ((mac->link_state != MAC80211_LINKED) \|\| (mac->cnt_after_linked < 5))
	572	return;
	573
	574	if (rtlpriv->link_info.busytraffic)
	575	return;
	576
6539306b	577	mutex_lock(&rtlpriv->locks.ps_mutex);
4b9d8d67	578	rtl_ps_set_rf_state(hw, ERFSLEEP, RF_CHANGE_BY_PS);
6539306b	579	mutex_unlock(&rtlpriv->locks.ps_mutex);
cc7dc0c4 C	580
	581	if (ppsc->reg_rfps_level & RT_RF_OFF_LEVL_ASPM &&
	582	!RT_IN_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM)) {
	583	rtlpriv->intf_ops->enable_aspm(hw);
	584	RT_SET_PS_LEVEL(ppsc, RT_PS_LEVEL_ASPM);
	585	}
	586
	587	/* here is power save alg, when this beacon is DTIM
	588	* we will set sleep time to dtim_period * n;
	589	* when this beacon is not DTIM, we will set sleep
	590	* time to sleep_intv = rtlpriv->psc.dtim_counter or
	591	* MAX_SW_LPS_SLEEP_INTV(default set to 5) */
	592
	593	if (rtlpriv->psc.dtim_counter == 0) {
	594	if (hw->conf.ps_dtim_period == 1)
	595	sleep_intv = hw->conf.ps_dtim_period * 2;
	596	else
	597	sleep_intv = hw->conf.ps_dtim_period;
	598	} else {
	599	sleep_intv = rtlpriv->psc.dtim_counter;
	600	}
	601
	602	if (sleep_intv > MAX_SW_LPS_SLEEP_INTV)
	603	sleep_intv = MAX_SW_LPS_SLEEP_INTV;
	604
	605	/* this print should always be dtim_conter = 0 &
	606	* sleep = dtim_period, that meaons, we should
	607	* awake before every dtim */
	608	RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG,
f30d7507 JP	609	"dtim_counter:%x will sleep :%d beacon_intv\n",
f30d7507 JP	610	rtlpriv->psc.dtim_counter, sleep_intv);
cc7dc0c4 C	611
	612	/* we tested that 40ms is enough for sw & hw sw delay */
	613	queue_delayed_work(rtlpriv->works.rtl_wq, &rtlpriv->works.ps_rfon_wq,
	614	MSECS(sleep_intv * mac->vif->bss_conf.beacon_int - 40));
	615	}
	616
	617
	618	void rtl_swlps_wq_callback(void *data)
	619	{
	620	struct rtl_works *rtlworks = container_of_dwork_rtl(data,
	621	struct rtl_works,
	622	ps_work);
	623	struct ieee80211_hw *hw = rtlworks->hw;
	624	struct rtl_priv *rtlpriv = rtl_priv(hw);
	625	bool ps = false;
	626
	627	ps = (hw->conf.flags & IEEE80211_CONF_PS);
	628
	629	/* we can sleep after ps null send ok */
	630	if (rtlpriv->psc.state_inap) {
	631	rtl_swlps_rf_sleep(hw);
	632
	633	if (rtlpriv->psc.state && !ps) {
	634	rtlpriv->psc.sleep_ms = jiffies_to_msecs(jiffies -
	635	rtlpriv->psc.last_action);
	636	}
	637
	638	if (ps)
	639	rtlpriv->psc.last_slept = jiffies;
	640
	641	rtlpriv->psc.last_action = jiffies;
	642	rtlpriv->psc.state = ps;
	643	}
	644	}