1 /******************************************************************************
3 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
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.
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
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
19 ******************************************************************************/
23 /* This file is for 92CE/92CU dynamic mechanism only */
27 #define _RTL8188E_DM_C_
29 #include <osdep_service.h>
30 #include <drv_types.h>
32 #include <rtl8188e_hal.h>
34 static void dm_CheckStatistics(struct adapter *Adapter)
38 /* Initialize GPIO setting registers */
39 static void dm_InitGPIOSetting(struct adapter *Adapter)
43 tmp1byte = rtw_read8(Adapter, REG_GPIO_MUXCFG);
44 tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT);
46 rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte);
52 static void Init_ODM_ComInfo_88E(struct adapter *Adapter)
54 struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
55 struct dm_priv *pdmpriv = &hal_data->dmpriv;
56 struct odm_dm_struct *dm_odm = &(hal_data->odmpriv);
60 _rtw_memset(dm_odm, 0, sizeof(*dm_odm));
62 dm_odm->Adapter = Adapter;
64 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_PLATFORM, ODM_CE);
66 if (Adapter->interface_type == RTW_GSPI)
67 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO);
69 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_INTERFACE, Adapter->interface_type);/* RTL871X_HCI_TYPE */
71 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8188E);
76 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_FAB_VER, fab_ver);
77 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_CUT_VER, cut_ver);
79 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(hal_data->VersionID));
81 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_PATCH_ID, hal_data->CustomerID);
82 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_BWIFI_TEST, Adapter->registrypriv.wifi_spec);
85 if (hal_data->rf_type == RF_1T1R)
86 ODM_CmnInfoUpdate(dm_odm, ODM_CMNINFO_RF_TYPE, ODM_1T1R);
87 else if (hal_data->rf_type == RF_2T2R)
88 ODM_CmnInfoUpdate(dm_odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R);
89 else if (hal_data->rf_type == RF_1T2R)
90 ODM_CmnInfoUpdate(dm_odm, ODM_CMNINFO_RF_TYPE, ODM_1T2R);
92 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_RF_ANTENNA_TYPE, hal_data->TRxAntDivType);
94 pdmpriv->InitODMFlag = ODM_RF_CALIBRATION |
97 ODM_CmnInfoUpdate(dm_odm, ODM_CMNINFO_ABILITY, pdmpriv->InitODMFlag);
100 static void Update_ODM_ComInfo_88E(struct adapter *Adapter)
102 struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv;
103 struct mlme_priv *pmlmepriv = &Adapter->mlmepriv;
104 struct pwrctrl_priv *pwrctrlpriv = &Adapter->pwrctrlpriv;
105 struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
106 struct odm_dm_struct *dm_odm = &(hal_data->odmpriv);
107 struct dm_priv *pdmpriv = &hal_data->dmpriv;
110 pdmpriv->InitODMFlag = ODM_BB_DIG |
112 ODM_BB_DYNAMIC_TXPWR |
114 ODM_BB_RSSI_MONITOR |
120 if (hal_data->AntDivCfg)
121 pdmpriv->InitODMFlag |= ODM_BB_ANT_DIV;
123 if (Adapter->registrypriv.mp_mode == 1) {
124 pdmpriv->InitODMFlag = ODM_RF_CALIBRATION |
128 ODM_CmnInfoUpdate(dm_odm, ODM_CMNINFO_ABILITY, pdmpriv->InitODMFlag);
130 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_TX_UNI, &(Adapter->xmitpriv.tx_bytes));
131 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_RX_UNI, &(Adapter->recvpriv.rx_bytes));
132 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_WM_MODE, &(pmlmeext->cur_wireless_mode));
133 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(hal_data->nCur40MhzPrimeSC));
134 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_SEC_MODE, &(Adapter->securitypriv.dot11PrivacyAlgrthm));
135 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_BW, &(hal_data->CurrentChannelBW));
136 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_CHNL, &(hal_data->CurrentChannel));
137 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_NET_CLOSED, &(Adapter->net_closed));
138 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_MP_MODE, &(Adapter->registrypriv.mp_mode));
139 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_SCAN, &(pmlmepriv->bScanInProcess));
140 ODM_CmnInfoHook(dm_odm, ODM_CMNINFO_POWER_SAVING, &(pwrctrlpriv->bpower_saving));
141 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_RF_ANTENNA_TYPE, hal_data->TRxAntDivType);
143 for (i = 0; i < NUM_STA; i++)
144 ODM_CmnInfoPtrArrayHook(dm_odm, ODM_CMNINFO_STA_STATUS, i, NULL);
147 void rtl8188e_InitHalDm(struct adapter *Adapter)
149 struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
150 struct dm_priv *pdmpriv = &hal_data->dmpriv;
151 struct odm_dm_struct *dm_odm = &(hal_data->odmpriv);
153 dm_InitGPIOSetting(Adapter);
154 pdmpriv->DM_Type = DM_Type_ByDriver;
155 pdmpriv->DMFlag = DYNAMIC_FUNC_DISABLE;
156 Update_ODM_ComInfo_88E(Adapter);
158 Adapter->fix_rate = 0xFF;
161 void rtl8188e_HalDmWatchDog(struct adapter *Adapter)
163 bool fw_cur_in_ps = false;
164 bool fw_ps_awake = true;
165 u8 hw_init_completed = false;
166 struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
169 hw_init_completed = Adapter->hw_init_completed;
171 if (!hw_init_completed)
174 fw_cur_in_ps = Adapter->pwrctrlpriv.bFwCurrentInPSMode;
175 rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&fw_ps_awake));
177 /* Fw is under p2p powersaving mode, driver should stop dynamic mechanism. */
178 /* modifed by thomas. 2011.06.11. */
179 if (Adapter->wdinfo.p2p_ps_mode)
182 if (hw_init_completed && ((!fw_cur_in_ps) && fw_ps_awake)) {
183 /* Calculate Tx/Rx statistics. */
184 dm_CheckStatistics(Adapter);
190 if (hw_init_completed) {
191 struct mlme_priv *pmlmepriv = &Adapter->mlmepriv;
194 if ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) ||
195 (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE))) {
196 if (Adapter->stapriv.asoc_sta_count > 2)
198 } else {/* Station mode */
199 if (check_fwstate(pmlmepriv, _FW_LINKED))
203 ODM_CmnInfoUpdate(&hal_data->odmpriv, ODM_CMNINFO_LINK, bLinked);
204 ODM_DMWatchdog(&hal_data->odmpriv);
207 /* Check GPIO to determine current RF on/off and Pbc status. */
208 /* Check Hardware Radio ON/OFF or not */
212 void rtl8188e_init_dm_priv(struct adapter *Adapter)
214 struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
215 struct dm_priv *pdmpriv = &hal_data->dmpriv;
216 struct odm_dm_struct *podmpriv = &hal_data->odmpriv;
218 _rtw_memset(pdmpriv, 0, sizeof(struct dm_priv));
219 Init_ODM_ComInfo_88E(Adapter);
220 ODM_InitDebugSetting(podmpriv);
223 void rtl8188e_deinit_dm_priv(struct adapter *Adapter)
227 /* Add new function to reset the state of antenna diversity before link. */
228 /* Compare RSSI for deciding antenna */
229 void AntDivCompare8188E(struct adapter *Adapter, struct wlan_bssid_ex *dst, struct wlan_bssid_ex *src)
231 struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
233 if (0 != hal_data->AntDivCfg) {
234 /* select optimum_antenna for before linked =>For antenna diversity */
235 if (dst->Rssi >= src->Rssi) {/* keep org parameter */
236 src->Rssi = dst->Rssi;
237 src->PhyInfo.Optimum_antenna = dst->PhyInfo.Optimum_antenna;
242 /* Add new function to reset the state of antenna diversity before link. */
243 u8 AntDivBeforeLink8188E(struct adapter *Adapter)
245 struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
246 struct odm_dm_struct *dm_odm = &hal_data->odmpriv;
247 struct sw_ant_switch *dm_swat_tbl = &dm_odm->DM_SWAT_Table;
248 struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv);
250 /* Condition that does not need to use antenna diversity. */
251 if (hal_data->AntDivCfg == 0)
254 if (check_fwstate(pmlmepriv, _FW_LINKED))
257 if (dm_swat_tbl->SWAS_NoLink_State == 0) {
259 dm_swat_tbl->SWAS_NoLink_State = 1;
260 dm_swat_tbl->CurAntenna = (dm_swat_tbl->CurAntenna == Antenna_A) ? Antenna_B : Antenna_A;
262 rtw_antenna_select_cmd(Adapter, dm_swat_tbl->CurAntenna, false);
265 dm_swat_tbl->SWAS_NoLink_State = 0;