/****************************************************************************** * * Copyright(c) 2007 - 2019 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. * *****************************************************************************/ #define _RTW_PWRCTRL_C_ #include #ifdef CONFIG_RTW_IPS bool rtw_core_set_ips_state(void *drv_priv, enum rtw_rf_state state) { struct dvobj_priv *dvobj = (struct dvobj_priv *)drv_priv; enum rtw_phl_status pstatus = RTW_PHL_STATUS_FAILURE; if (state == RTW_RF_ON) { pstatus = rtw_phl_rf_on(dvobj->phl); } else if (state == RTW_RF_OFF) { pstatus = rtw_phl_rf_off(dvobj->phl); } if (RTW_PHL_STATUS_SUCCESS == pstatus) return true; else return false; } #endif #ifdef DBG_CHECK_FW_PS_STATE int rtw_fw_ps_state(_adapter *padapter) { struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; int ret = _FAIL, dont_care = 0; u8 ps_state = 0; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct registry_priv *registry_par = &padapter->registrypriv; if (registry_par->check_fw_ps != 1) return _SUCCESS; _enter_pwrlock(&pwrpriv->check_32k_lock); if (RTW_CANNOT_RUN(psdpriv)) { RTW_INFO("%s: bSurpriseRemoved=%s , hw_init_completed=%d, bDriverStopped=%s\n", __func__ , dev_is_surprise_removed(adapter_to_dvobj(padapter)) ? "True" : "False" , rtw_hw_get_init_completed(adapter_to_dvobj(padapter)) , dev_is_drv_stopped(adapter_to_dvobj(padapter)) ? "True" : "False"); goto exit_fw_ps_state; } rtw_hal_get_hwreg(padapter, HW_VAR_FW_PS_STATE, (u8 *)&ps_state); if (ps_state == PS_ACTIVE) { ret = _SUCCESS; } else { pdbgpriv->dbg_poll_fail_cnt++; RTW_INFO("%s: fw_ps_state=%04x\n", __func__, ps_state); } exit_fw_ps_state: _exit_pwrlock(&pwrpriv->check_32k_lock); return ret; } #endif /*DBG_CHECK_FW_PS_STATE*/ #ifdef CONFIG_IPS void _ips_enter(_adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); pwrpriv->bips_processing = _TRUE; /* syn ips_mode with request */ pwrpriv->ips_mode = pwrpriv->ips_mode_req; pwrpriv->ips_enter_cnts++; RTW_INFO("==>ips_enter cnts:%d\n", pwrpriv->ips_enter_cnts); if (rf_off == pwrpriv->change_rfpwrstate) { pwrpriv->bpower_saving = _TRUE; RTW_PRINT("nolinked power save enter\n"); if (pwrpriv->ips_mode == IPS_LEVEL_2) pwrpriv->bkeepfwalive = _TRUE; #ifdef CONFIG_RTW_CFGVENDOR_LLSTATS pwrpriv->pwr_saving_start_time = rtw_get_current_time(); #endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ rtw_ips_pwr_down(padapter); pwrpriv->rf_pwrstate = rf_off; } pwrpriv->bips_processing = _FALSE; } void ips_enter(_adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); _enter_pwrlock(&pwrpriv->lock); _ips_enter(padapter); _exit_pwrlock(&pwrpriv->lock); #ifdef CONFIG_PCI_DYNAMIC_ASPM rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PS); #endif } int _ips_leave(_adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); int result = _SUCCESS; if ((pwrpriv->rf_pwrstate == rf_off) && (!pwrpriv->bips_processing)) { pwrpriv->bips_processing = _TRUE; pwrpriv->change_rfpwrstate = rf_on; pwrpriv->ips_leave_cnts++; RTW_INFO("==>ips_leave cnts:%d\n", pwrpriv->ips_leave_cnts); result = rtw_ips_pwr_up(padapter); if (result == _SUCCESS) pwrpriv->rf_pwrstate = rf_on; #ifdef CONFIG_RTW_CFGVENDOR_LLSTATS pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); #endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ RTW_PRINT("nolinked power save leave\n"); #if 0 /*GEORGIA_TODO_REDEFINE_IO*/ RTW_INFO("==> ips_leave.....LED(0x%08x)...\n", rtw_read32(padapter, 0x4c)); #endif pwrpriv->bips_processing = _FALSE; pwrpriv->bkeepfwalive = _FALSE; pwrpriv->bpower_saving = _FALSE; } return result; } int ips_leave(_adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); #ifdef DBG_CHECK_FW_PS_STATE struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; #endif int ret; if (!is_primary_adapter(padapter)) return _SUCCESS; _enter_pwrlock(&pwrpriv->lock); ret = _ips_leave(padapter); #ifdef DBG_CHECK_FW_PS_STATE if (rtw_fw_ps_state(padapter) == _FAIL) { RTW_INFO("ips leave doesn't leave 32k\n"); pdbgpriv->dbg_leave_ips_fail_cnt++; } #endif /* DBG_CHECK_FW_PS_STATE */ _exit_pwrlock(&pwrpriv->lock); #ifdef CONFIG_PCI_DYNAMIC_ASPM rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PERF); #endif return ret; } #endif /* CONFIG_IPS */ #ifdef CONFIG_POWER_SAVING bool rtw_pwr_unassociated_idle(_adapter *adapter) { u8 i; _adapter *iface; struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); struct xmit_priv *pxmit_priv = &adapter->xmitpriv; struct mlme_priv *pmlmepriv; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo; #endif u8 xmitbuf_nr = GET_HAL_XMITBUF_NR(dvobj); u8 xmitbuf_ext_nr = GET_HAL_XMITBUF_EXT_NR(dvobj); bool ret = _FALSE; if (adapter_to_pwrctl(adapter)->bpower_saving == _TRUE) { /* RTW_INFO("%s: already in LPS or IPS mode\n", __func__); */ goto exit; } if (rtw_time_after(adapter_to_pwrctl(adapter)->ips_deny_time, rtw_get_current_time())) { /* RTW_INFO("%s ips_deny_time\n", __func__); */ goto exit; } for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if ((iface) && rtw_is_adapter_up(iface)) { pmlmepriv = &(iface->mlmepriv); #ifdef CONFIG_P2P pwdinfo = &(iface->wdinfo); #endif if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | WIFI_UNDER_SURVEY) || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) || MLME_IS_AP(iface) || MLME_IS_MESH(iface) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) || rtw_cfg80211_get_is_roch(iface) == _TRUE || (rtw_cfg80211_is_ro_ch_once(adapter) && rtw_cfg80211_get_last_ro_ch_passing_ms(adapter) < 3000) #endif ) goto exit; } } #if (MP_DRIVER == 1) if (adapter->registrypriv.mp_mode == 1) goto exit; #endif if (pxmit_priv->free_xmitbuf_cnt != xmitbuf_nr || pxmit_priv->free_xmit_extbuf_cnt != xmitbuf_ext_nr) { RTW_PRINT("There are some pkts to transmit\n"); RTW_PRINT("free_xmitbuf_cnt: %d, free_xmit_extbuf_cnt: %d\n", pxmit_priv->free_xmitbuf_cnt, pxmit_priv->free_xmit_extbuf_cnt); goto exit; } ret = _TRUE; exit: return ret; } /* * ATTENTION: * rtw_ps_processor() doesn't handle LPS. */ void rtw_ps_processor(_adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; u32 ps_deny = 0; _enter_pwrlock(&adapter_to_pwrctl(padapter)->lock); ps_deny = rtw_ps_deny_get(padapter); _exit_pwrlock(&adapter_to_pwrctl(padapter)->lock); if (ps_deny != 0) { if (!MLME_IS_MONITOR(padapter)) { RTW_INFO(FUNC_ADPT_FMT ": ps_deny=0x%08X, skip power save!\n", FUNC_ADPT_ARG(padapter), ps_deny); } goto exit; } if (pwrpriv->bInSuspend == _TRUE) { /* system suspend or autosuspend */ pdbgpriv->dbg_ps_insuspend_cnt++; RTW_INFO("%s, pwrpriv->bInSuspend == _TRUE ignore this process\n", __FUNCTION__); return; } pwrpriv->ps_processing = _TRUE; if (pwrpriv->ips_mode_req == IPS_NONE) goto exit; if (rtw_pwr_unassociated_idle(padapter) == _FALSE) goto exit; if ((pwrpriv->rf_pwrstate == rf_on) && ((pwrpriv->pwr_state_check_cnts % 4) == 0)) { RTW_INFO("==>%s .fw_state(%x)\n", __FUNCTION__, get_fwstate(pmlmepriv)); pwrpriv->change_rfpwrstate = rf_off; #ifdef CONFIG_IPS ips_enter(padapter); #endif } exit: #ifndef CONFIG_IPS_CHECK_IN_WD rtw_set_pwr_state_check_timer(pwrpriv); #endif pwrpriv->ps_processing = _FALSE; return; } #endif #ifdef CONFIG_POWER_SAVING void pwr_state_check_handler(void *ctx) { _adapter *padapter = (_adapter *)ctx; rtw_ps_cmd(padapter); } #endif #ifdef CONFIG_LPS #ifdef CONFIG_CHECK_LEAVE_LPS #ifdef CONFIG_LPS_CHK_BY_TP void traffic_check_for_leave_lps_by_tp(_adapter *padapter, u8 tx, struct sta_info *sta) { struct stainfo_stats *pstats = &sta->sta_stats; u64 cur_acc_tx_bytes = 0, cur_acc_rx_bytes = 0; u32 tx_tp_kbyte = 0, rx_tp_kbyte = 0; u32 tx_tp_th = 0, rx_tp_th = 0; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); u8 leave_lps = _FALSE; if (tx) { /* from tx */ cur_acc_tx_bytes = pstats->tx_bytes - pstats->acc_tx_bytes; tx_tp_kbyte = cur_acc_tx_bytes >> 10; tx_tp_th = pwrpriv->lps_tx_tp_th * 1024 / 8 * 2; /*KBytes @2s*/ if (tx_tp_kbyte >= tx_tp_th || padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod >= pwrpriv->lps_tx_pkts){ if (pwrpriv->bLeisurePs && (pwrpriv->pwr_mode != PM_PS_MODE_ACTIVE) ) { leave_lps = _TRUE; } } } else { /* from rx path */ cur_acc_rx_bytes = pstats->rx_bytes - pstats->acc_rx_bytes; rx_tp_kbyte = cur_acc_rx_bytes >> 10; rx_tp_th = pwrpriv->lps_rx_tp_th * 1024 / 8 * 2; if (rx_tp_kbyte>= rx_tp_th || padapter->mlmepriv.LinkDetectInfo.NumRxUnicastOkInPeriod >= pwrpriv->lps_rx_pkts) { if (pwrpriv->bLeisurePs && (pwrpriv->pwr_mode != PM_PS_MODE_ACTIVE) ) { leave_lps = _TRUE; } } } if (leave_lps) { #ifdef DBG_LPS_CHK_BY_TP RTW_INFO("leave lps via %s, ", tx ? "Tx" : "Rx"); if (tx) RTW_INFO("Tx = %d [%d] (KB)\n", tx_tp_kbyte, tx_tp_th); else RTW_INFO("Rx = %d [%d] (KB)\n", rx_tp_kbyte, rx_tp_th); #endif pwrpriv->lps_chk_cnt = pwrpriv->lps_chk_cnt_th; /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); */ rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, 0); } } #endif /*CONFIG_LPS_CHK_BY_TP*/ void traffic_check_for_leave_lps(_adapter *padapter, u8 tx, u32 tx_packets) { static systime start_time = 0; static u32 xmit_cnt = 0; u8 bLeaveLPS = _FALSE; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; if (tx) { /* from tx */ xmit_cnt += tx_packets; if (start_time == 0) start_time = rtw_get_current_time(); if (rtw_get_passing_time_ms(start_time) > 2000) { /* 2 sec == watch dog timer */ if (xmit_cnt > 8) { if ((adapter_to_pwrctl(padapter)->bLeisurePs) && (adapter_to_pwrctl(padapter)->pwr_mode != PM_PS_MODE_ACTIVE) ) { /* RTW_INFO("leave lps via Tx = %d\n", xmit_cnt); */ bLeaveLPS = _TRUE; } } start_time = rtw_get_current_time(); xmit_cnt = 0; } } else { /* from rx path */ if (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4/*2*/) { if ((adapter_to_pwrctl(padapter)->bLeisurePs) && (adapter_to_pwrctl(padapter)->pwr_mode != PM_PS_MODE_ACTIVE) ) { /* RTW_INFO("leave lps via Rx = %d\n", pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ bLeaveLPS = _TRUE; } } } if (bLeaveLPS) { /* RTW_INFO("leave lps via %s, Tx = %d, Rx = %d\n", tx?"Tx":"Rx", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); */ rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, tx ? RTW_CMDF_DIRECTLY : 0); } } #endif /* CONFIG_CHECK_LEAVE_LPS */ #ifdef CONFIG_LPS_LCLK #define LPS_CPWM_TIMEOUT_MS 10 /*ms*/ #define LPS_RPWM_RETRY_CNT 3 u8 rtw_cpwm_polling(_adapter *adapter, u8 rpwm, u8 cpwm_orig) { u8 rst = _FAIL; u8 cpwm_now = 0; systime start_time; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); #ifdef DBG_CHECK_FW_PS_STATE struct debug_priv *pdbgpriv = &(adapter_to_dvobj(adapter)->drv_dbg); #endif pwrpriv->rpwm_retry = 0; do { start_time = rtw_get_current_time(); do { rtw_msleep_os(1); rtw_hal_get_hwreg(adapter, HW_VAR_CPWM, &cpwm_now); if ((cpwm_orig ^ cpwm_now) & 0x80) { pwrpriv->cpwm = PS_STATE_S4; pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; rst = _SUCCESS; break; } } while (rtw_get_passing_time_ms(start_time) < LPS_CPWM_TIMEOUT_MS && !RTW_CANNOT_RUN(adapter_to_dvobj(adapter))); if (rst == _SUCCESS) break; else { /* rpwm retry */ cpwm_orig = cpwm_now; rpwm &= ~PS_TOGGLE; rpwm |= pwrpriv->tog; rtw_hal_set_hwreg(adapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); pwrpriv->tog += 0x80; } } while (pwrpriv->rpwm_retry++ < LPS_RPWM_RETRY_CNT && !RTW_CANNOT_RUN(adapter_to_dvobj(adapter))); if (rst == _SUCCESS) { #ifdef DBG_CHECK_FW_PS_STATE RTW_INFO("%s: polling cpwm OK! rpwm_retry=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" , __func__, pwrpriv->rpwm_retry, cpwm_orig, cpwm_now, rtw_read8(adapter, REG_CR)); if (rtw_fw_ps_state(adapter) == _FAIL) { RTW_INFO("leave 32k but fw state in 32k\n"); pdbgpriv->dbg_rpwm_toogle_cnt++; } #endif /* DBG_CHECK_FW_PS_STATE */ } else { RTW_ERR("%s: polling cpwm timeout! rpwm_retry=%d, cpwm_orig=%02x, cpwm_now=%02x\n" , __func__, pwrpriv->rpwm_retry, cpwm_orig, cpwm_now); #ifdef DBG_CHECK_FW_PS_STATE if (rtw_fw_ps_state(adapter) == _FAIL) { RTW_INFO("rpwm timeout and fw ps state in 32k\n"); pdbgpriv->dbg_rpwm_timeout_fail_cnt++; } #endif /* DBG_CHECK_FW_PS_STATE */ #ifdef CONFIG_LPS_RPWM_TIMER _set_timer(&pwrpriv->pwr_rpwm_timer, 1); #endif /* CONFIG_LPS_RPWM_TIMER */ } return rst; } #endif /* * Description: * This function MUST be called under power lock protect * * Parameters * padapter * pslv power state level, only could be PS_STATE_S0 ~ PS_STATE_S4 * */ u8 rtw_set_rpwm(_adapter *padapter, u8 pslv) { u8 rpwm = 0xFF; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); #ifdef CONFIG_LPS_LCLK u8 cpwm_orig; #endif struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); pslv = PS_STATE(pslv); #ifdef CONFIG_LPS_RPWM_TIMER if (pwrpriv->brpwmtimeout == _TRUE) RTW_INFO("%s: RPWM timeout, force to set RPWM(0x%02X) again!\n", __FUNCTION__, pslv); else #endif /* CONFIG_LPS_RPWM_TIMER */ { if ((pwrpriv->rpwm == pslv) #ifdef CONFIG_LPS_LCLK || ((pwrpriv->rpwm >= PS_STATE_S2) && (pslv >= PS_STATE_S2)) #endif || (pwrpriv->lps_level == LPS_NORMAL) ) { return rpwm; } } if (dev_is_surprise_removed(dvobj) || (!rtw_hw_is_init_completed(dvobj))) { pwrpriv->cpwm = PS_STATE_S4; return rpwm; } if (dev_is_drv_stopped(dvobj)) if (pslv < PS_STATE_S2) return rpwm; rpwm = pslv | pwrpriv->tog; #ifdef CONFIG_LPS_LCLK /* only when from PS_STATE S0/S1 to S2 and higher needs ACK */ if ((pwrpriv->cpwm < PS_STATE_S2) && (pslv >= PS_STATE_S2)) rpwm |= PS_ACK; #endif pwrpriv->rpwm = pslv; #ifdef CONFIG_LPS_LCLK cpwm_orig = 0; if (rpwm & PS_ACK) rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); #endif #if defined(CONFIG_LPS_RPWM_TIMER) && !defined(CONFIG_DETECT_CPWM_BY_POLLING) if (rpwm & PS_ACK) { #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) if (pwrpriv->wowlan_mode != _TRUE && pwrpriv->wowlan_ap_mode != _TRUE && pwrpriv->wowlan_p2p_mode != _TRUE) #endif _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_CPWM_TIMEOUT_MS); } #endif /* CONFIG_LPS_RPWM_TIMER & !CONFIG_DETECT_CPWM_BY_POLLING */ rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); pwrpriv->tog += 0x80; #ifdef CONFIG_LPS_LCLK /* No LPS 32K, No Ack */ if (rpwm & PS_ACK) { #ifdef CONFIG_DETECT_CPWM_BY_POLLING rtw_cpwm_polling(padapter, rpwm, cpwm_orig); #else #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) if (pwrpriv->wowlan_mode == _TRUE || pwrpriv->wowlan_ap_mode == _TRUE || pwrpriv->wowlan_p2p_mode == _TRUE) rtw_cpwm_polling(padapter, rpwm, cpwm_orig); #endif /*#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN)*/ #endif /*#ifdef CONFIG_DETECT_CPWM_BY_POLLING*/ } else #endif /* CONFIG_LPS_LCLK */ { pwrpriv->cpwm = pslv; } return rpwm; } u8 PS_RDY_CHECK(_adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) if (_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) return _TRUE; else if (_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_ap_mode) return _TRUE; else if (_TRUE == pwrpriv->bInSuspend) return _FALSE; #else if (_TRUE == pwrpriv->bInSuspend) return _FALSE; #endif if (rtw_time_after(pwrpriv->lps_deny_time, rtw_get_current_time())) return _FALSE; if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY) || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) || MLME_IS_AP(padapter) || MLME_IS_MESH(padapter) || MLME_IS_MONITOR(padapter) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) || rtw_cfg80211_get_is_roch(padapter) == _TRUE #endif || rtw_is_scan_deny(padapter) #ifdef CONFIG_TDLS /* TDLS link is established. */ || (padapter->tdlsinfo.link_established == _TRUE) #endif /* CONFIG_TDLS */ #ifdef CONFIG_DFS_MASTER || adapter_to_rfctl(padapter)->radar_detect_enabled #endif ) return _FALSE; if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == _FALSE)) { RTW_INFO("Group handshake still in progress !!!\n"); return _FALSE; } #ifdef CONFIG_IOCTL_CFG80211 if (!rtw_cfg80211_pwr_mgmt(padapter)) return _FALSE; #endif return _TRUE; } void rtw_leave_lps_and_chk(_adapter *padapter, u8 ps_mode) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); #ifdef CONFIG_LPS_ACK _rtw_mutex_lock_interruptible(&pwrpriv->lps_ack_mutex); rtw_sctx_init(&pwrpriv->lps_ack_sctx, 100); #endif /* CONFIG_LPS_ACK */ rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); rtw_hal_set_hwreg(padapter, HW_VAR_LPS_STATE_CHK, (u8 *)(&ps_mode)); #ifdef CONFIG_LPS_ACK _rtw_mutex_unlock(&pwrpriv->lps_ack_mutex); #endif /* CONFIG_LPS_ACK */ } void rtw_set_ps_mode(_adapter *padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; #endif #ifdef CONFIG_WMMPS_STA struct registry_priv *pregistrypriv = &padapter->registrypriv; #endif #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #endif /* CONFIG_P2P */ #ifdef CONFIG_TDLS struct sta_priv *pstapriv = &padapter->stapriv; int i, j; _list *plist, *phead; struct sta_info *ptdls_sta; #endif /* CONFIG_TDLS */ #ifdef CONFIG_LPS_PG u8 lps_pg_hdl_id = 0; #endif if (ps_mode > PM_CARD_DISABLE) { return; } if (pwrpriv->pwr_mode == ps_mode) { if (PM_PS_MODE_ACTIVE == ps_mode) return; #ifndef CONFIG_BTC #ifdef CONFIG_WMMPS_STA if (!rtw_is_wmmps_mode(padapter)) #endif /* CONFIG_WMMPS_STA */ if ((pwrpriv->smart_ps == smart_ps) && (pwrpriv->bcn_ant_mode == bcn_ant_mode)) return; #endif /* !CONFIG_BTC */ } #ifdef CONFIG_FW_MULTI_PORT_SUPPORT if (PM_PS_MODE_ACTIVE != ps_mode) { rtw_set_ps_rsvd_page(padapter); rtw_set_default_port_id(padapter); } #endif #ifdef CONFIG_LPS_PG if ((PM_PS_MODE_ACTIVE != ps_mode) && (pwrpriv->lps_level == LPS_PG)) { if (pwrpriv->wowlan_mode != _TRUE) { /*rtw_hal_set_lps_pg_info(padapter);*/ lps_pg_hdl_id = LPS_PG_INFO_CFG; rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); } } #endif #ifdef CONFIG_LPS_LCLK _enter_pwrlock(&pwrpriv->lock); #endif /* if(pwrpriv->pwr_mode == PM_PS_MODE_ACTIVE) */ if (ps_mode == PM_PS_MODE_ACTIVE) { if (1 #ifdef CONFIG_P2P_PS && (pwdinfo->opp_ps == 0) #endif /* CONFIG_P2P_PS */ ) { RTW_INFO(FUNC_ADPT_FMT" Leave 802.11 power save - %s\n", FUNC_ADPT_ARG(padapter), msg); if (pwrpriv->lps_leave_cnts < UINT_MAX) pwrpriv->lps_leave_cnts++; else pwrpriv->lps_leave_cnts = 0; #ifdef CONFIG_TDLS for (i = 0; i < NUM_STA; i++) { phead = &(pstapriv->sta_hash[i]); plist = get_next(phead); while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->phl_sta->mac_addr, 0, 0, 0); plist = get_next(plist); } } #endif /* CONFIG_TDLS */ pwrpriv->pwr_mode = ps_mode; rtw_set_rpwm(padapter, PS_STATE_S4); #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) if (pwrpriv->wowlan_mode == _TRUE || pwrpriv->wowlan_ap_mode == _TRUE || pwrpriv->wowlan_p2p_mode == _TRUE) { systime start_time; u32 delay_ms; u8 val8; delay_ms = 20; start_time = rtw_get_current_time(); do { rtw_hal_get_hwreg(padapter, HW_VAR_SYS_CLKR, &val8); if (!(val8 & BIT(4))) { /* 0x08 bit4 =1 --> in 32k, bit4 = 0 --> leave 32k */ pwrpriv->cpwm = PS_STATE_S4; break; } if (rtw_get_passing_time_ms(start_time) > delay_ms) { RTW_INFO("%s: Wait for FW 32K leave more than %u ms!!!\n", __FUNCTION__, delay_ms); pdbgpriv->dbg_wow_leave_ps_fail_cnt++; break; } rtw_usleep_os(100); } while (1); } #endif #ifdef CONFIG_LPS_PG if (pwrpriv->lps_level == LPS_PG) { lps_pg_hdl_id = LPS_PG_REDLEMEM; rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); } #endif #ifdef CONFIG_WOWLAN if (pwrpriv->wowlan_mode == _TRUE) rtw_hal_set_hwreg(padapter, HW_VAR_H2C_INACTIVE_IPS, (u8 *)(&ps_mode)); #endif /* CONFIG_WOWLAN */ rtw_leave_lps_and_chk(padapter, ps_mode); #ifdef CONFIG_LPS_PG if (pwrpriv->lps_level == LPS_PG) { lps_pg_hdl_id = LPS_PG_PHYDM_EN; rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); } #endif pwrpriv->bFwCurrentInPSMode = _FALSE; } } else { if ((PS_RDY_CHECK(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) #ifdef CONFIG_P2P_WOWLAN || (_TRUE == pwrpriv->wowlan_p2p_mode) #endif /* CONFIG_P2P_WOWLAN */ #ifdef CONFIG_WOWLAN || WOWLAN_IS_STA_MIX_MODE(padapter) #endif /* CONFIG_WOWLAN */ ) { u8 pslv; RTW_INFO(FUNC_ADPT_FMT" Enter 802.11 power save - %s\n", FUNC_ADPT_ARG(padapter), msg); if (pwrpriv->lps_enter_cnts < UINT_MAX) pwrpriv->lps_enter_cnts++; else pwrpriv->lps_enter_cnts = 0; #ifdef CONFIG_TDLS for (i = 0; i < NUM_STA; i++) { phead = &(pstapriv->sta_hash[i]); plist = get_next(phead); while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->phl_sta->mac_addr, 1, 0, 0); plist = get_next(plist); } } #endif /* CONFIG_TDLS */ pwrpriv->bFwCurrentInPSMode = _TRUE; pwrpriv->pwr_mode = ps_mode; pwrpriv->smart_ps = smart_ps; pwrpriv->bcn_ant_mode = bcn_ant_mode; #ifdef CONFIG_LPS_PG if (pwrpriv->lps_level == LPS_PG) { lps_pg_hdl_id = LPS_PG_PHYDM_DIS; rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); } #endif #ifdef CONFIG_WMMPS_STA pwrpriv->wmm_smart_ps = pregistrypriv->wmm_smart_ps; #endif /* CONFIG_WMMPS_STA */ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); #ifdef CONFIG_WOWLAN if (pwrpriv->wowlan_mode == _TRUE) rtw_hal_set_hwreg(padapter, HW_VAR_H2C_INACTIVE_IPS, (u8 *)(&ps_mode)); #endif /* CONFIG_WOWLAN */ #ifdef CONFIG_P2P_PS /* Set CTWindow after LPS */ if (pwdinfo->opp_ps == 1) p2p_ps_wk_cmd(padapter, P2P_PS_ENABLE, 0); #endif /* CONFIG_P2P_PS */ pslv = PS_STATE_S2; #ifdef CONFIG_LPS_LCLK if (pwrpriv->alives == 0) pslv = PS_STATE_S0; #endif /* CONFIG_LPS_LCLK */ rtw_set_rpwm(padapter, pslv); } } #ifdef CONFIG_LPS_LCLK _exit_pwrlock(&pwrpriv->lock); #endif } const char * const LPS_CTRL_PHYDM = "LPS_CTRL_PHYDM"; /* * Description: * Enter the leisure power save mode. * */ void LPS_Enter(_adapter *padapter, const char *msg) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); int i; char buf[32] = {0}; #ifdef DBG_LA_MODE struct registry_priv *registry_par = &(padapter->registrypriv); #endif /* RTW_INFO("+LeisurePSEnter\n"); */ #if 0 /*GEORGIA_TODO_FIXIT*/ if (GET_PHL_COM(dvobj)->fw_ready == _FALSE) return; #endif #ifdef DBG_LA_MODE if(registry_par->la_mode_en == 1) { RTW_INFO("%s LA debug mode lps_leave \n", __func__); return; } #endif /* Skip lps enter request if number of assocated adapters is not 1 */ if (rtw_mi_get_assoc_if_num(padapter) != 1) return; #ifndef CONFIG_FW_MULTI_PORT_SUPPORT /* Skip lps enter request for adapter not port0 */ if (get_hw_port(padapter) != HW_PORT0) return; #endif for (i = 0; i < dvobj->iface_nums; i++) { if (PS_RDY_CHECK(dvobj->padapters[i]) == _FALSE) return; } #ifdef CONFIG_P2P_PS if (padapter->wdinfo.p2p_ps_mode == P2P_PS_NOA) { return;/* supporting p2p client ps NOA via H2C_8723B_P2P_PS_OFFLOAD */ } #endif /* CONFIG_P2P_PS */ if (pwrpriv->bLeisurePs) { /* Idle for a while if we connect to AP a while ago. */ if (pwrpriv->LpsIdleCount >= 2) { /* 4 Sec */ if (pwrpriv->pwr_mode == PM_PS_MODE_ACTIVE) { #ifdef CONFIG_WMMPS_STA if (rtw_is_wmmps_mode(padapter)) msg = "WMMPS_IDLE"; #endif /* CONFIG_WMMPS_STA */ sprintf(buf, "WIFI-%s", msg); pwrpriv->bpower_saving = _TRUE; #ifdef CONFIG_RTW_CFGVENDOR_LLSTATS pwrpriv->pwr_saving_start_time = rtw_get_current_time(); #endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); #ifdef CONFIG_PCI_DYNAMIC_ASPM if (msg != LPS_CTRL_PHYDM) rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PS); #endif } } else pwrpriv->LpsIdleCount++; } /* RTW_INFO("-LeisurePSEnter\n"); */ } /* * Description: * Leave the leisure power save mode. * */ void LPS_Leave(_adapter *padapter, const char *msg) { #define LPS_LEAVE_TIMEOUT_MS 100 struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); char buf[32] = {0}; #ifdef DBG_CHECK_FW_PS_STATE struct debug_priv *pdbgpriv = &dvobj->drv_dbg; #endif /* RTW_INFO("+LeisurePSLeave\n"); */ if (pwrpriv->bLeisurePs) { if (pwrpriv->pwr_mode != PM_PS_MODE_ACTIVE) { #ifdef CONFIG_PCI_DYNAMIC_ASPM if (msg != LPS_CTRL_PHYDM) rtw_pci_dynamic_aspm_set_mode(padapter, ASPM_MODE_PERF); #endif #ifdef CONFIG_WMMPS_STA if (rtw_is_wmmps_mode(padapter)) msg = "WMMPS_BUSY"; #endif /* CONFIG_WMMPS_STA */ sprintf(buf, "WIFI-%s", msg); rtw_set_ps_mode(padapter, PM_PS_MODE_ACTIVE, 0, 0, buf); #ifdef CONFIG_RTW_CFGVENDOR_LLSTATS pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); #endif /* CONFIG_RTW_CFGVENDOR_LLSTATS */ } } pwrpriv->bpower_saving = _FALSE; #ifdef DBG_CHECK_FW_PS_STATE if (rtw_fw_ps_state(padapter) == _FAIL) { RTW_INFO("leave lps, fw in 32k\n"); pdbgpriv->dbg_leave_lps_fail_cnt++; } #endif /* DBG_CHECK_FW_PS_STATE * RTW_INFO("-LeisurePSLeave\n"); */ } #endif /* CONFIG_LPS */ void LeaveAllPowerSaveModeDirect(_adapter *adapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); _adapter *pri_padapter = GET_PRIMARY_ADAPTER(adapter); struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); #ifdef CONFIG_LPS_LCLK #ifndef CONFIG_DETECT_CPWM_BY_POLLING u8 cpwm_orig; #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ u8 rpwm; #endif int i; RTW_INFO("%s.....\n", __FUNCTION__); if (dev_is_surprise_removed(adapter_to_dvobj(adapter))) { RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(adapter)); return; } if (rtw_mi_check_status(adapter, MI_LINKED)) { /*connect*/ if (pwrpriv->pwr_mode == PM_PS_MODE_ACTIVE) { RTW_INFO("%s: Driver Already Leave LPS\n", __FUNCTION__); return; } #ifdef CONFIG_LPS_LCLK _enter_pwrlock(&pwrpriv->lock); #ifndef CONFIG_DETECT_CPWM_BY_POLLING cpwm_orig = 0; rtw_hal_get_hwreg(adapter, HW_VAR_CPWM, &cpwm_orig); #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ rpwm = rtw_set_rpwm(adapter, PS_STATE_S4); #ifndef CONFIG_DETECT_CPWM_BY_POLLING if (rpwm != 0xFF && rpwm & PS_ACK) rtw_cpwm_polling(adapter, rpwm, cpwm_orig); #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ _exit_pwrlock(&pwrpriv->lock); #endif/*CONFIG_LPS_LCLK*/ #ifdef CONFIG_P2P_PS for (i = 0; i < dvobj->iface_nums; i++) { _adapter *iface = dvobj->padapters[i]; struct wifidirect_info *pwdinfo = &(iface->wdinfo); if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) p2p_ps_wk_cmd(iface, P2P_PS_DISABLE, 0); } #endif /* CONFIG_P2P_PS */ #ifdef CONFIG_LPS rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, RTW_CMDF_DIRECTLY); #endif } else { if (pwrpriv->rf_pwrstate == rf_off) { #if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) #ifdef CONFIG_IPS if (_FALSE == ips_leave(pri_padapter)) RTW_INFO("======> ips_leave fail.............\n"); #endif #endif /* defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) */ } } } /* * Description: Leave all power save mode: LPS, FwLPS, IPS if needed. * Move code to function by tynli. 2010.03.26. * */ void LeaveAllPowerSaveMode(_adapter *adapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); u8 enqueue = 0; int i; /* RTW_INFO(FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(adapter));*/ if (dev_is_surprise_removed(adapter_to_dvobj(adapter))) { RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(adapter)); return; } if (rtw_mi_get_assoc_if_num(adapter)) { /* connect */ #ifdef CONFIG_LPS_LCLK enqueue = 1; #endif #ifdef CONFIG_P2P_PS for (i = 0; i < dvobj->iface_nums; i++) { _adapter *iface = dvobj->padapters[i]; struct wifidirect_info *pwdinfo = &(iface->wdinfo); if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) p2p_ps_wk_cmd(iface, P2P_PS_DISABLE, enqueue); } #endif /* CONFIG_P2P_PS */ #ifdef CONFIG_LPS rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_LEAVE, enqueue ? 0 : RTW_CMDF_DIRECTLY); #endif #ifdef CONFIG_LPS_LCLK LPS_Leave_check(adapter); #endif } else { if (adapter_to_pwrctl(adapter)->rf_pwrstate == rf_off) { #if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) #ifdef CONFIG_IPS if (_FALSE == ips_leave(adapter)) RTW_INFO("======> ips_leave fail.............\n"); #endif #endif /* defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) */ } } } #ifdef CONFIG_LPS_LCLK void LPS_Leave_check( _adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); systime start_time; u8 bReady; bReady = _FALSE; start_time = rtw_get_current_time(); rtw_yield_os(); while (1) { _enter_pwrlock(&pwrpriv->lock); if (dev_is_surprise_removed(dvobj) || (!rtw_hw_is_init_completed(dvobj)) #ifdef CONFIG_USB_HCI || dev_is_drv_stopped(dvobj) #endif || (pwrpriv->pwr_mode == PM_PS_MODE_ACTIVE) ) bReady = _TRUE; _exit_pwrlock(&pwrpriv->lock); if (_TRUE == bReady) break; if (rtw_get_passing_time_ms(start_time) > 100) { RTW_ERR("Wait for cpwm event than 100 ms!!!\n"); break; } rtw_msleep_os(1); } } /* * Caller:ISR handler... * * This will be called when CPWM interrupt is up. * * using to update cpwn of drv; and drv willl make a decision to up or down pwr level */ void cpwm_int_hdl( _adapter *padapter, struct reportpwrstate_parm *preportpwrstate) { struct pwrctrl_priv *pwrpriv; if (!padapter) goto exit; if (RTW_CANNOT_RUN(adapter_to_dvobj(padapter))) goto exit; pwrpriv = adapter_to_pwrctl(padapter); #if 0 if (pwrpriv->cpwm_tog == (preportpwrstate->state & PS_TOGGLE)) { goto exit; } #endif _enter_pwrlock(&pwrpriv->lock); #ifdef CONFIG_LPS_RPWM_TIMER if (pwrpriv->rpwm < PS_STATE_S2) { RTW_INFO("%s: Redundant CPWM Int. RPWM=0x%02X CPWM=0x%02x\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); _exit_pwrlock(&pwrpriv->lock); goto exit; } #endif /* CONFIG_LPS_RPWM_TIMER */ pwrpriv->cpwm = PS_STATE(preportpwrstate->state); pwrpriv->cpwm_tog = preportpwrstate->state & PS_TOGGLE; if (pwrpriv->cpwm >= PS_STATE_S2) { #if 0 /*#ifdef CONFIG_CORE_CMD_THREAD*/ if (pwrpriv->alives & CMD_ALIVE) _rtw_up_sema(&padapter->cmdpriv.cmd_queue_sema); #endif #if 0 /*def CONFIG_XMIT_THREAD_MODE*/ if (pwrpriv->alives & XMIT_ALIVE) _rtw_up_sema(&padapter->xmitpriv.xmit_sema); #endif } _exit_pwrlock(&pwrpriv->lock); exit: return; } static void cpwm_event_callback(struct work_struct *work) { struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, cpwm_event); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); _adapter *adapter = dvobj_get_primary_adapter(dvobj); struct reportpwrstate_parm report; /* RTW_INFO("%s\n",__FUNCTION__); */ report.state = PS_STATE_S2; cpwm_int_hdl(adapter, &report); } static void dma_event_callback(struct work_struct *work) { struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, dma_event); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); _adapter *adapter = dvobj_get_primary_adapter(dvobj); rtw_unregister_tx_alive(adapter); } #ifdef CONFIG_LPS_RPWM_TIMER #if defined(DBG_CPWM_CHK_FAIL) extern void rtw_cpwm_chk_fail_debug(_adapter *padapter, struct pwrctrl_priv *pwrpriv); #endif static void rpwmtimeout_workitem_callback(struct work_struct *work) { _adapter *padapter; struct dvobj_priv *dvobj; struct pwrctrl_priv *pwrpriv; pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); dvobj = pwrctl_to_dvobj(pwrpriv); padapter = dvobj_get_primary_adapter(dvobj); if (!padapter) return; if (RTW_CANNOT_RUN(dvobj)) return; _enter_pwrlock(&pwrpriv->lock); if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { RTW_INFO("%s: rpwm=0x%02X cpwm=0x%02X CPWM done!\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); goto exit; } if (pwrpriv->rpwm_retry++ < LPS_RPWM_RETRY_CNT) { u8 rpwm = (pwrpriv->rpwm | pwrpriv->tog | PS_ACK); rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); pwrpriv->tog += 0x80; _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_CPWM_TIMEOUT_MS); goto exit; } pwrpriv->rpwm_retry = 0; _exit_pwrlock(&pwrpriv->lock); #if defined(DBG_CPWM_CHK_FAIL) rtw_cpwm_chk_fail_debug(padapter, pwrpriv); #endif #if 0 /*GEORGIA_TODO_REDEFINE_IO*/ if (rtw_read8(padapter, 0x100) != 0xEA) #else if (!rtw_hal_is_leave_ps(padapter)) #endif { #if 1 struct reportpwrstate_parm report; report.state = PS_STATE_S2; RTW_INFO("\n%s: FW already leave 32K!\n\n", __func__); cpwm_int_hdl(padapter, &report); #else RTW_INFO("\n%s: FW already leave 32K!\n\n", __func__); cpwm_event_callback(&pwrpriv->cpwm_event); #endif return; } _enter_pwrlock(&pwrpriv->lock); if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { RTW_INFO("%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); goto exit; } pwrpriv->brpwmtimeout = _TRUE; rtw_set_rpwm(padapter, pwrpriv->rpwm); pwrpriv->brpwmtimeout = _FALSE; exit: _exit_pwrlock(&pwrpriv->lock); } /* * This function is a timer handler, can't do any IO in it. */ static void pwr_rpwm_timeout_handler(void *FunctionContext) { _adapter *padapter; struct pwrctrl_priv *pwrpriv; padapter = (_adapter *)FunctionContext; if (!padapter) return; pwrpriv = adapter_to_pwrctl(padapter); if (RTW_CANNOT_RUN(adapter_to_dvobj(padapter))) return; RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { RTW_INFO("+%s: cpwm=%d, nothing to do!\n", __func__, pwrpriv->cpwm); return; } _set_workitem(&pwrpriv->rpwmtimeoutwi); } #endif /* CONFIG_LPS_RPWM_TIMER */ __inline static void register_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) { pwrctrl->alives |= tag; } __inline static void unregister_task_alive(struct pwrctrl_priv *pwrctrl, u32 tag) { pwrctrl->alives &= ~tag; } /* * Description: * Check if the fw_pwrstate is okay for I/O. * If not (cpwm is less than S2), then the sub-routine * will raise the cpwm to be greater than or equal to S2. * * Calling Context: Passive * * Constraint: * 1. this function will request pwrctrl->lock * * Return Value: * _SUCCESS hardware is ready for I/O * _FAIL can't I/O right now */ s32 rtw_register_task_alive(_adapter *padapter, u32 task) { s32 res; struct pwrctrl_priv *pwrctrl; u8 pslv; res = _SUCCESS; pwrctrl = adapter_to_pwrctl(padapter); pslv = PS_STATE_S2; _enter_pwrlock(&pwrctrl->lock); register_task_alive(pwrctrl, task); if (pwrctrl->bFwCurrentInPSMode == _TRUE) { if (pwrctrl->cpwm < pslv) { if (pwrctrl->cpwm < PS_STATE_S2) res = _FAIL; if (pwrctrl->rpwm < pslv) rtw_set_rpwm(padapter, pslv); } } _exit_pwrlock(&pwrctrl->lock); #ifdef CONFIG_DETECT_CPWM_BY_POLLING if (_FAIL == res) { if (pwrctrl->cpwm >= PS_STATE_S2) res = _SUCCESS; } #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ return res; } /* * Description: * If task is done, call this func. to power down firmware again. * * Constraint: * 1. this function will request pwrctrl->lock * * Return Value: * none */ void rtw_unregister_task_alive(_adapter *padapter, u32 task) { struct pwrctrl_priv *pwrctrl; u8 pslv; pwrctrl = adapter_to_pwrctl(padapter); pslv = PS_STATE_S0; _enter_pwrlock(&pwrctrl->lock); unregister_task_alive(pwrctrl, task); if ((pwrctrl->pwr_mode != PM_PS_MODE_ACTIVE) && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { if (pwrctrl->cpwm > pslv) { if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) rtw_set_rpwm(padapter, pslv); } } _exit_pwrlock(&pwrctrl->lock); } /* * Caller: rtw_xmit_thread * * Check if the fw_pwrstate is okay for xmit. * If not (cpwm is less than S3), then the sub-routine * will raise the cpwm to be greater than or equal to S3. * * Calling Context: Passive * * Return Value: * _SUCCESS rtw_xmit_thread can write fifo/txcmd afterwards. * _FAIL rtw_xmit_thread can not do anything. */ s32 rtw_register_tx_alive(_adapter *padapter) { s32 res; struct pwrctrl_priv *pwrctrl; u8 pslv; res = _SUCCESS; pwrctrl = adapter_to_pwrctl(padapter); pslv = PS_STATE_S2; _enter_pwrlock(&pwrctrl->lock); register_task_alive(pwrctrl, XMIT_ALIVE); if (pwrctrl->bFwCurrentInPSMode == _TRUE) { if (pwrctrl->cpwm < pslv) { if (pwrctrl->cpwm < PS_STATE_S2) res = _FAIL; if (pwrctrl->rpwm < pslv) rtw_set_rpwm(padapter, pslv); } } _exit_pwrlock(&pwrctrl->lock); #ifdef CONFIG_DETECT_CPWM_BY_POLLING if (_FAIL == res) { if (pwrctrl->cpwm >= PS_STATE_S2) res = _SUCCESS; } #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ return res; } /* * Caller: rtw_cmd_thread * * Check if the fw_pwrstate is okay for issuing cmd. * If not (cpwm should be is less than S2), then the sub-routine * will raise the cpwm to be greater than or equal to S2. * * Calling Context: Passive * * Return Value: * _SUCCESS rtw_cmd_thread can issue cmds to firmware afterwards. * _FAIL rtw_cmd_thread can not do anything. */ #if 0 /*#ifdef CONFIG_CORE_CMD_THREAD*/ s32 rtw_register_cmd_alive(_adapter *padapter) { s32 res; struct pwrctrl_priv *pwrctrl; u8 pslv; res = _SUCCESS; pwrctrl = adapter_to_pwrctl(padapter); pslv = PS_STATE_S2; _enter_pwrlock(&pwrctrl->lock); register_task_alive(pwrctrl, CMD_ALIVE); if (pwrctrl->bFwCurrentInPSMode == _TRUE) { if (pwrctrl->cpwm < pslv) { if (pwrctrl->cpwm < PS_STATE_S2) res = _FAIL; if (pwrctrl->rpwm < pslv) rtw_set_rpwm(padapter, pslv); } } _exit_pwrlock(&pwrctrl->lock); #ifdef CONFIG_DETECT_CPWM_BY_POLLING if (_FAIL == res) { if (pwrctrl->cpwm >= PS_STATE_S2) res = _SUCCESS; } #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ return res; } #endif /* * Caller: rx_isr * * Calling Context: Dispatch/ISR * * Return Value: * _SUCCESS * _FAIL */ s32 rtw_register_rx_alive(_adapter *padapter) { struct pwrctrl_priv *pwrctrl; pwrctrl = adapter_to_pwrctl(padapter); _enter_pwrlock(&pwrctrl->lock); register_task_alive(pwrctrl, RECV_ALIVE); _exit_pwrlock(&pwrctrl->lock); return _SUCCESS; } /* * Caller: ISR * * If ISR's txdone, * No more pkts for TX, * Then driver shall call this fun. to power down firmware again. */ void rtw_unregister_tx_alive(_adapter *padapter) { struct pwrctrl_priv *pwrctrl; _adapter *iface; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); u8 pslv, i; pwrctrl = adapter_to_pwrctl(padapter); pslv = PS_STATE_S0; #ifdef CONFIG_P2P_PS for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if ((iface) && rtw_is_adapter_up(iface)) { if (iface->wdinfo.p2p_ps_mode > P2P_PS_NONE) { pslv = PS_STATE_S2; break; } } } #endif _enter_pwrlock(&pwrctrl->lock); unregister_task_alive(pwrctrl, XMIT_ALIVE); if ((pwrctrl->pwr_mode != PM_PS_MODE_ACTIVE) && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { if (pwrctrl->cpwm > pslv) { if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) rtw_set_rpwm(padapter, pslv); } } _exit_pwrlock(&pwrctrl->lock); } /* * Caller: ISR * * If all commands have been done, * and no more command to do, * then driver shall call this fun. to power down firmware again. */ #if 0 /*#ifdef CONFIG_CORE_CMD_THREAD*/ void rtw_unregister_cmd_alive(_adapter *padapter) { _adapter *iface; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct pwrctrl_priv *pwrctrl; u8 pslv, i; pwrctrl = adapter_to_pwrctl(padapter); pslv = PS_STATE_S0; #ifdef CONFIG_P2P_PS for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if ((iface) && rtw_is_adapter_up(iface)) { if (iface->wdinfo.p2p_ps_mode > P2P_PS_NONE) { pslv = PS_STATE_S2; break; } } } #endif _enter_pwrlock(&pwrctrl->lock); unregister_task_alive(pwrctrl, CMD_ALIVE); if ((pwrctrl->pwr_mode != PM_PS_MODE_ACTIVE) && (pwrctrl->bFwCurrentInPSMode == _TRUE)) { if (pwrctrl->cpwm > pslv) { if ((pslv >= PS_STATE_S2) || (pwrctrl->alives == 0)) rtw_set_rpwm(padapter, pslv); } } _exit_pwrlock(&pwrctrl->lock); } #endif /* * Caller: ISR */ void rtw_unregister_rx_alive(_adapter *padapter) { struct pwrctrl_priv *pwrctrl; pwrctrl = adapter_to_pwrctl(padapter); _enter_pwrlock(&pwrctrl->lock); unregister_task_alive(pwrctrl, RECV_ALIVE); _exit_pwrlock(&pwrctrl->lock); } #endif /* CONFIG_LPS_LCLK */ #ifdef CONFIG_RESUME_IN_WORKQUEUE static void resume_workitem_callback(struct work_struct *work); #endif /* CONFIG_RESUME_IN_WORKQUEUE */ void rtw_init_pwrctrl_priv(_adapter *padapter) { #ifdef CONFIG_LPS_1T1R #define LPS_1T1R_FMT ", LPS_1T1R=%d" #define LPS_1T1R_ARG , pwrctrlpriv->lps_1t1r #else #define LPS_1T1R_FMT "" #define LPS_1T1R_ARG #endif struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); #if defined(CONFIG_CONCURRENT_MODE) if (!is_primary_adapter(padapter)) return; #endif _init_pwrlock(&pwrctrlpriv->lock); _init_pwrlock(&pwrctrlpriv->check_32k_lock); pwrctrlpriv->rf_pwrstate = rf_on; pwrctrlpriv->ips_enter_cnts = 0; pwrctrlpriv->ips_leave_cnts = 0; pwrctrlpriv->lps_enter_cnts = 0; pwrctrlpriv->lps_leave_cnts = 0; pwrctrlpriv->bips_processing = _FALSE; #ifdef CONFIG_LPS_CHK_BY_TP pwrctrlpriv->lps_chk_by_tp = padapter->registrypriv.lps_chk_by_tp; pwrctrlpriv->lps_tx_tp_th = LPS_TX_TP_TH; pwrctrlpriv->lps_rx_tp_th = LPS_RX_TP_TH; pwrctrlpriv->lps_bi_tp_th = LPS_BI_TP_TH; pwrctrlpriv->lps_chk_cnt = pwrctrlpriv->lps_chk_cnt_th = LPS_TP_CHK_CNT; pwrctrlpriv->lps_tx_pkts = LPS_CHK_PKTS_TX; pwrctrlpriv->lps_rx_pkts = LPS_CHK_PKTS_RX; #endif pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; pwrctrlpriv->ips_deny_time = rtw_get_current_time(); pwrctrlpriv->lps_level = padapter->registrypriv.lps_level; #ifdef CONFIG_LPS_1T1R pwrctrlpriv->lps_1t1r = padapter->registrypriv.lps_1t1r; #endif pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; pwrctrlpriv->pwr_state_check_cnts = 0; pwrctrlpriv->bInSuspend = _FALSE; pwrctrlpriv->bkeepfwalive = _FALSE; pwrctrlpriv->LpsIdleCount = 0; /* pwrctrlpriv->FWCtrlPSMode =padapter->registrypriv.power_mgnt; */ /* PM_PS_MODE_MIN; */ if (padapter->registrypriv.mp_mode == 1) pwrctrlpriv->power_mgnt = PM_PS_MODE_ACTIVE ; else pwrctrlpriv->power_mgnt = padapter->registrypriv.power_mgnt; /* PM_PS_MODE_MIN; */ pwrctrlpriv->bLeisurePs = (PM_PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt) ? _TRUE : _FALSE; pwrctrlpriv->bFwCurrentInPSMode = _FALSE; pwrctrlpriv->lps_deny_time = rtw_get_current_time(); pwrctrlpriv->rpwm = 0; pwrctrlpriv->cpwm = PS_STATE_S4; pwrctrlpriv->pwr_mode = PM_PS_MODE_ACTIVE; pwrctrlpriv->smart_ps = padapter->registrypriv.smart_ps; pwrctrlpriv->bcn_ant_mode = 0; pwrctrlpriv->dtim = 0; pwrctrlpriv->tog = 0x80; pwrctrlpriv->rpwm_retry = 0; RTW_INFO("%s: IPS_mode=%d, LPS_mode=%d, LPS_level=%d"LPS_1T1R_FMT"\n", __func__, pwrctrlpriv->ips_mode, pwrctrlpriv->power_mgnt, pwrctrlpriv->lps_level LPS_1T1R_ARG ); #ifdef CONFIG_LPS_LCLK rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&pwrctrlpriv->rpwm)); _init_workitem(&pwrctrlpriv->cpwm_event, cpwm_event_callback, NULL); _init_workitem(&pwrctrlpriv->dma_event, dma_event_callback, NULL); #ifdef CONFIG_LPS_RPWM_TIMER pwrctrlpriv->brpwmtimeout = _FALSE; _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); rtw_init_timer(&pwrctrlpriv->pwr_rpwm_timer, pwr_rpwm_timeout_handler, padapter); #endif /* CONFIG_LPS_RPWM_TIMER */ #endif /* CONFIG_LPS_LCLK */ #ifdef CONFIG_LPS_PG pwrctrlpriv->lpspg_info.name = "LPSPG_INFO"; #ifdef CONFIG_RTL8822C pwrctrlpriv->lpspg_dpk_info.name = "LPSPG_DPK_INFO"; pwrctrlpriv->lpspg_iqk_info.name = "LPSPG_IQK_INFO"; #endif #endif #ifdef CONFIG_POWER_SAVING rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, pwr_state_check_handler, padapter); #endif #ifdef CONFIG_RESUME_IN_WORKQUEUE _init_workitem(&pwrctrlpriv->resume_work, resume_workitem_callback, NULL); pwrctrlpriv->rtw_workqueue = create_singlethread_workqueue("rtw_workqueue"); #endif /* CONFIG_RESUME_IN_WORKQUEUE */ #ifdef CONFIG_LPS_ACK _rtw_mutex_init(&pwrctrlpriv->lps_ack_mutex); pwrctrlpriv->lps_ack_status = -1; #endif /* CONFIG_LPS_ACK */ } void rtw_free_pwrctrl_priv(_adapter *adapter) { struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); #if defined(CONFIG_CONCURRENT_MODE) if (!is_primary_adapter(adapter)) return; #endif /* _rtw_memset((unsigned char *)pwrctrlpriv, 0, sizeof(struct pwrctrl_priv)); */ #ifdef CONFIG_RESUME_IN_WORKQUEUE if (pwrctrlpriv->rtw_workqueue) { flush_workqueue(pwrctrlpriv->rtw_workqueue); destroy_workqueue(pwrctrlpriv->rtw_workqueue); } #endif #ifdef CONFIG_LPS_LCLK _cancel_workitem_sync(&pwrctrlpriv->cpwm_event); _cancel_workitem_sync(&pwrctrlpriv->dma_event); #ifdef CONFIG_LPS_RPWM_TIMER _cancel_workitem_sync(&pwrctrlpriv->rpwmtimeoutwi); #endif #endif /* CONFIG_LPS_LCLK */ #ifdef CONFIG_LPS_PG rsvd_page_cache_free(&pwrctrlpriv->lpspg_info); #ifdef CONFIG_RTL8822C rsvd_page_cache_free(&pwrctrlpriv->lpspg_dpk_info); rsvd_page_cache_free(&pwrctrlpriv->lpspg_iqk_info); #endif #endif _free_pwrlock(&pwrctrlpriv->lock); _free_pwrlock(&pwrctrlpriv->check_32k_lock); #ifdef CONFIG_LPS_ACK _rtw_mutex_free(&pwrctrlpriv->lps_ack_mutex); #endif /* CONFIG_LPS_ACK */ } #ifdef CONFIG_RESUME_IN_WORKQUEUE extern int rtw_resume_process(_adapter *padapter); static void resume_workitem_callback(struct work_struct *work) { struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, resume_work); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); _adapter *adapter = dvobj_get_primary_adapter(dvobj); RTW_INFO("%s\n", __FUNCTION__); rtw_resume_process(adapter); rtw_resume_unlock_suspend(); } void rtw_resume_in_workqueue(struct pwrctrl_priv *pwrpriv) { /* accquire system's suspend lock preventing from falliing asleep while resume in workqueue */ /* rtw_lock_suspend(); */ rtw_resume_lock_suspend(); #if 1 queue_work(pwrpriv->rtw_workqueue, &pwrpriv->resume_work); #else _set_workitem(&pwrpriv->resume_work); #endif } #endif /* CONFIG_RESUME_IN_WORKQUEUE */ #if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) inline bool rtw_is_earlysuspend_registered(struct pwrctrl_priv *pwrpriv) { return (pwrpriv->early_suspend.suspend) ? _TRUE : _FALSE; } inline bool rtw_is_do_late_resume(struct pwrctrl_priv *pwrpriv) { return (pwrpriv->do_late_resume) ? _TRUE : _FALSE; } inline void rtw_set_do_late_resume(struct pwrctrl_priv *pwrpriv, bool enable) { pwrpriv->do_late_resume = enable; } #endif #ifdef CONFIG_HAS_EARLYSUSPEND extern int rtw_resume_process(_adapter *padapter); static void rtw_early_suspend(struct early_suspend *h) { struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); RTW_INFO("%s\n", __FUNCTION__); rtw_set_do_late_resume(pwrpriv, _FALSE); } static void rtw_late_resume(struct early_suspend *h) { struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); _adapter *adapter = dvobj_get_primary_adapter(dvobj); RTW_INFO("%s\n", __FUNCTION__); if (pwrpriv->do_late_resume) { rtw_set_do_late_resume(pwrpriv, _FALSE); rtw_resume_process(adapter); } } void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) { RTW_INFO("%s\n", __FUNCTION__); /* jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit */ pwrpriv->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; pwrpriv->early_suspend.suspend = rtw_early_suspend; pwrpriv->early_suspend.resume = rtw_late_resume; register_early_suspend(&pwrpriv->early_suspend); } void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) { RTW_INFO("%s\n", __FUNCTION__); rtw_set_do_late_resume(pwrpriv, _FALSE); if (pwrpriv->early_suspend.suspend) unregister_early_suspend(&pwrpriv->early_suspend); pwrpriv->early_suspend.suspend = NULL; pwrpriv->early_suspend.resume = NULL; } #endif /* CONFIG_HAS_EARLYSUSPEND */ #ifdef CONFIG_ANDROID_POWER #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) extern int rtw_resume_process(_adapter *padapter); #endif static void rtw_early_suspend(android_early_suspend_t *h) { struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); RTW_INFO("%s\n", __FUNCTION__); rtw_set_do_late_resume(pwrpriv, _FALSE); } static void rtw_late_resume(android_early_suspend_t *h) { struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); _adapter *adapter = dvobj_get_primary_adapter(dvobj); RTW_INFO("%s\n", __FUNCTION__); if (pwrpriv->do_late_resume) { #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) rtw_set_do_late_resume(pwrpriv, _FALSE); rtw_resume_process(adapter); #endif } } void rtw_register_early_suspend(struct pwrctrl_priv *pwrpriv) { RTW_INFO("%s\n", __FUNCTION__); /* jeff: set the early suspend level before blank screen, so we wll do late resume after scree is lit */ pwrpriv->early_suspend.level = ANDROID_EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20; pwrpriv->early_suspend.suspend = rtw_early_suspend; pwrpriv->early_suspend.resume = rtw_late_resume; android_register_early_suspend(&pwrpriv->early_suspend); } void rtw_unregister_early_suspend(struct pwrctrl_priv *pwrpriv) { RTW_INFO("%s\n", __FUNCTION__); rtw_set_do_late_resume(pwrpriv, _FALSE); if (pwrpriv->early_suspend.suspend) android_unregister_early_suspend(&pwrpriv->early_suspend); pwrpriv->early_suspend.suspend = NULL; pwrpriv->early_suspend.resume = NULL; } #endif /* CONFIG_ANDROID_POWER */ inline void rtw_set_ips_deny(_adapter *padapter, u32 ms) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ms); } /* * rtw_pwr_wakeup - Wake the NIC up from: 1)IPS. 2)USB autosuspend * @adapter: pointer to _adapter structure * @ips_deffer_ms: the ms wiil prevent from falling into IPS after wakeup * Return _SUCCESS or _FAIL */ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) { int ret = _SUCCESS; #ifdef CONFIG_POWER_SAVING struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); struct mlme_priv *pmlmepriv; systime start = rtw_get_current_time(); /*RTW_INFO(FUNC_ADPT_FMT "===>\n", FUNC_ADPT_ARG(padapter));*/ /* for LPS */ LeaveAllPowerSaveMode(padapter); /* IPS still bound with primary adapter */ padapter = GET_PRIMARY_ADAPTER(padapter); pmlmepriv = &padapter->mlmepriv; if (rtw_time_after(rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms), pwrpriv->ips_deny_time)) pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); if (pwrpriv->ps_processing) { RTW_INFO("%s wait ps_processing...\n", __func__); while (pwrpriv->ps_processing && rtw_get_passing_time_ms(start) <= 3000) rtw_msleep_os(10); if (pwrpriv->ps_processing) RTW_INFO("%s wait ps_processing timeout\n", __func__); else RTW_INFO("%s wait ps_processing done\n", __func__); } #ifdef DBG_CONFIG_ERROR_DETECT if (rtw_hal_sreset_inprogress(padapter)) { RTW_INFO("%s wait sreset_inprogress...\n", __func__); while (rtw_hal_sreset_inprogress(padapter) && rtw_get_passing_time_ms(start) <= 4000) rtw_msleep_os(10); if (rtw_hal_sreset_inprogress(padapter)) RTW_INFO("%s wait sreset_inprogress timeout\n", __func__); else RTW_INFO("%s wait sreset_inprogress done\n", __func__); } #endif if (pwrpriv->bInSuspend) { RTW_INFO("%s wait bInSuspend...\n", __func__); while (pwrpriv->bInSuspend && ((rtw_get_passing_time_ms(start) <= 3000 && !rtw_is_do_late_resume(pwrpriv)) || (rtw_get_passing_time_ms(start) <= 500 && rtw_is_do_late_resume(pwrpriv))) ) rtw_msleep_os(10); if (pwrpriv->bInSuspend) RTW_INFO("%s wait bInSuspend timeout\n", __func__); else RTW_INFO("%s wait bInSuspend done\n", __func__); } /* System suspend is not allowed to wakeup */ if (_TRUE == pwrpriv->bInSuspend) { ret = _FAIL; goto exit; } /* I think this should be check in IPS, LPS, autosuspend functions... */ if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE) { ret = _SUCCESS; goto exit; } if (rf_off == pwrpriv->rf_pwrstate) { #ifdef CONFIG_IPS RTW_INFO("%s call ips_leave....\n", __FUNCTION__); if (_FAIL == ips_leave(padapter)) { RTW_INFO("======> ips_leave fail.............\n"); ret = _FAIL; goto exit; } #endif } /* TODO: the following checking need to be merged... */ if (dev_is_drv_stopped(dvobj) || !padapter->netif_up || !rtw_hw_is_init_completed(dvobj) ) { RTW_INFO("%s: bDriverStopped=%s, netif_up=%d, hw_init_completed=%u\n" , caller , dev_is_drv_stopped(dvobj) ? "True" : "False" , padapter->netif_up , rtw_hw_get_init_completed(dvobj)); ret = _FALSE; goto exit; } exit: if (rtw_time_after(rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms), pwrpriv->ips_deny_time)) pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); /*RTW_INFO(FUNC_ADPT_FMT "<===\n", FUNC_ADPT_ARG(padapter));*/ #endif return ret; } int rtw_pm_set_lps(_adapter *padapter, u8 mode) { int ret = 0; struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); if (mode < PM_PS_MODE_NUM) { if (pwrctrlpriv->power_mgnt != mode) { if (PM_PS_MODE_ACTIVE == mode) LeaveAllPowerSaveMode(padapter); else pwrctrlpriv->LpsIdleCount = 2; pwrctrlpriv->power_mgnt = mode; pwrctrlpriv->bLeisurePs = (PM_PS_MODE_ACTIVE != pwrctrlpriv->power_mgnt) ? _TRUE : _FALSE; } } else ret = -EINVAL; return ret; } int rtw_pm_set_lps_level(_adapter *padapter, u8 level) { int ret = 0; struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); if (level < LPS_LEVEL_MAX) { if (pwrctrlpriv->lps_level != level) { #ifdef CONFIG_LPS if (rtw_lps_ctrl_leave_set_level_cmd(padapter, level, RTW_CMDF_WAIT_ACK) != _SUCCESS) #endif pwrctrlpriv->lps_level = level; } } else ret = -EINVAL; return ret; } #ifdef CONFIG_LPS_1T1R int rtw_pm_set_lps_1t1r(_adapter *padapter, u8 en) { int ret = 0; struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); en = en ? 1 : 0; if (pwrctrlpriv->lps_1t1r != en) { if (rtw_lps_ctrl_leave_set_1t1r_cmd(padapter, en, RTW_CMDF_WAIT_ACK) != _SUCCESS) pwrctrlpriv->lps_1t1r = en; } return ret; } #endif inline void rtw_set_lps_deny(_adapter *adapter, u32 ms) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); pwrpriv->lps_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ms); } int rtw_pm_set_ips(_adapter *padapter, u8 mode) { struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); if (mode == IPS_NORMAL || mode == IPS_LEVEL_2) { rtw_ips_mode_req(pwrctrlpriv, mode); RTW_INFO("%s %s\n", __FUNCTION__, mode == IPS_NORMAL ? "IPS_NORMAL" : "IPS_LEVEL_2"); return 0; } else if (mode == IPS_NONE) { rtw_ips_mode_req(pwrctrlpriv, mode); RTW_INFO("%s %s\n", __FUNCTION__, "IPS_NONE"); if (!dev_is_surprise_removed(adapter_to_dvobj(padapter)) && (_FAIL == rtw_pwr_wakeup(padapter))) return -EFAULT; } else return -EINVAL; return 0; } /* * ATTENTION: * This function will request pwrctrl LOCK! */ void rtw_ps_deny(_adapter *padapter, PS_DENY_REASON reason) { struct pwrctrl_priv *pwrpriv; /* RTW_INFO("+" FUNC_ADPT_FMT ": Request PS deny for %d (0x%08X)\n", * FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ pwrpriv = adapter_to_pwrctl(padapter); _enter_pwrlock(&pwrpriv->lock); if (pwrpriv->ps_deny & BIT(reason)) { RTW_INFO(FUNC_ADPT_FMT ": [WARNING] Reason %d had been set before!!\n", FUNC_ADPT_ARG(padapter), reason); } pwrpriv->ps_deny |= BIT(reason); _exit_pwrlock(&pwrpriv->lock); /* RTW_INFO("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", * FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ } /* * ATTENTION: * This function will request pwrctrl LOCK! */ void rtw_ps_deny_cancel(_adapter *padapter, PS_DENY_REASON reason) { struct pwrctrl_priv *pwrpriv; /* RTW_INFO("+" FUNC_ADPT_FMT ": Cancel PS deny for %d(0x%08X)\n", * FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ pwrpriv = adapter_to_pwrctl(padapter); _enter_pwrlock(&pwrpriv->lock); if ((pwrpriv->ps_deny & BIT(reason)) == 0) { RTW_INFO(FUNC_ADPT_FMT ": [ERROR] Reason %d had been canceled before!!\n", FUNC_ADPT_ARG(padapter), reason); } pwrpriv->ps_deny &= ~BIT(reason); _exit_pwrlock(&pwrpriv->lock); /* RTW_INFO("-" FUNC_ADPT_FMT ": Now PS deny for 0x%08X\n", * FUNC_ADPT_ARG(padapter), pwrpriv->ps_deny); */ } /* * ATTENTION: * Before calling this function pwrctrl lock should be occupied already, * otherwise it may return incorrect value. */ u32 rtw_ps_deny_get(_adapter *padapter) { u32 deny; deny = adapter_to_pwrctl(padapter)->ps_deny; return deny; } static void _rtw_ssmps(_adapter *adapter, struct sta_info *sta) { struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); issue_action_SM_PS_wait_ack(adapter , get_my_bssid(&(pmlmeinfo->network)), sta->phl_sta->asoc_cap.sm_ps, 3 , 1); if (sta->phl_sta->asoc_cap.sm_ps == SM_PS_STATIC) { pmlmeext->txss_bk = sta->phl_sta->asoc_cap.nss_rx; sta->phl_sta->asoc_cap.nss_rx = 1; } else { sta->phl_sta->asoc_cap.nss_rx = pmlmeext->txss_bk; } rtw_phl_cmd_change_stainfo(adapter_to_dvobj(adapter)->phl, sta->phl_sta, STA_CHG_RAMASK, NULL, 0, PHL_CMD_DIRECTLY, 0); } void rtw_ssmps_enter(_adapter *adapter, struct sta_info *sta) { if (MLME_IS_AP(adapter)) return; if (sta->phl_sta->asoc_cap.sm_ps == SM_PS_STATIC) return; RTW_INFO(ADPT_FMT" STA [" MAC_FMT "]\n", ADPT_ARG(adapter), MAC_ARG(sta->phl_sta->mac_addr)); sta->phl_sta->asoc_cap.sm_ps = SM_PS_STATIC; _rtw_ssmps(adapter, sta); } void rtw_ssmps_leave(_adapter *adapter, struct sta_info *sta) { if (MLME_IS_AP(adapter)) return; if (sta->phl_sta->asoc_cap.sm_ps == SM_PS_DISABLE) return; RTW_INFO(ADPT_FMT" STA [" MAC_FMT "] \n", ADPT_ARG(adapter), MAC_ARG(sta->phl_sta->mac_addr)); sta->phl_sta->asoc_cap.sm_ps = SM_PS_DISABLE; _rtw_ssmps(adapter, sta); }