drivers/staging/rtl8188eu/hal/rtl8188e_dm.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   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  *
  19  ******************************************************************************/
  20 /*  */
  21 /*  Description: */
  22 /*  */
  23 /*  This file is for 92CE/92CU dynamic mechanism only */
  24 /*  */
  25 /*  */
  26 /*  */
  27 #define _RTL8188E_DM_C_
  28
  29 #include <osdep_service.h>
  30 #include <drv_types.h>
  31
  32 #include <rtl8188e_hal.h>
  33
  34 static void dm_CheckStatistics(struct adapter *Adapter)
  35 {
  36 }
  37
  38 /*  Initialize GPIO setting registers */
  39 static void dm_InitGPIOSetting(struct adapter *Adapter)
  40 {
  41         u8      tmp1byte;
  42
  43         tmp1byte = rtw_read8(Adapter, REG_GPIO_MUXCFG);
  44         tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT);
  45
  46         rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte);
  47 }
  48
  49 /*  */
  50 /*  functions */
  51 /*  */
  52 static void Init_ODM_ComInfo_88E(struct adapter *Adapter)
  53 {
  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);
  57         u8 cut_ver, fab_ver;
  58
  59         /*  Init Value */
  60         _rtw_memset(dm_odm, 0, sizeof(dm_odm));
  61
  62         dm_odm->Adapter = Adapter;
  63
  64         ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_PLATFORM, ODM_CE);
  65
  66         if (Adapter->interface_type == RTW_GSPI)
  67                 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO);
  68         else
  69                 ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_INTERFACE, Adapter->interface_type);/* RTL871X_HCI_TYPE */
  70
  71         ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_IC_TYPE, ODM_RTL8188E);
  72
  73         fab_ver = ODM_TSMC;
  74         cut_ver = ODM_CUT_A;
  75
  76         ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_FAB_VER, fab_ver);
  77         ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_CUT_VER, cut_ver);
  78
  79         ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(hal_data->VersionID));
  80
  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);
  83
  84
  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);
  91
  92         ODM_CmnInfoInit(dm_odm, ODM_CMNINFO_RF_ANTENNA_TYPE, hal_data->TRxAntDivType);
  93
  94         pdmpriv->InitODMFlag =  ODM_RF_CALIBRATION |
  95                                 ODM_RF_TX_PWR_TRACK;
  96
  97         ODM_CmnInfoUpdate(dm_odm, ODM_CMNINFO_ABILITY, pdmpriv->InitODMFlag);
  98 }
  99
 100 static void Update_ODM_ComInfo_88E(struct adapter *Adapter)
 101 {
 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;
 108         int i;
 109
 110         pdmpriv->InitODMFlag =  ODM_BB_DIG |
 111                                 ODM_BB_RA_MASK |
 112                                 ODM_BB_DYNAMIC_TXPWR |
 113                                 ODM_BB_FA_CNT |
 114                                 ODM_BB_RSSI_MONITOR |
 115                                 ODM_BB_CCK_PD |
 116                                 ODM_BB_PWR_SAVE |
 117                                 ODM_MAC_EDCA_TURBO |
 118                                 ODM_RF_CALIBRATION |
 119                                 ODM_RF_TX_PWR_TRACK;
 120         if (hal_data->AntDivCfg)
 121                 pdmpriv->InitODMFlag |= ODM_BB_ANT_DIV;
 122
 123         if (Adapter->registrypriv.mp_mode == 1) {
 124                 pdmpriv->InitODMFlag =  ODM_RF_CALIBRATION |
 125                                         ODM_RF_TX_PWR_TRACK;
 126         }
 127
 128         ODM_CmnInfoUpdate(dm_odm, ODM_CMNINFO_ABILITY, pdmpriv->InitODMFlag);
 129
 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);
 142
 143         for (i = 0; i < NUM_STA; i++)
 144                 ODM_CmnInfoPtrArrayHook(dm_odm, ODM_CMNINFO_STA_STATUS, i, NULL);
 145 }
 146
 147 void rtl8188e_InitHalDm(struct adapter *Adapter)
 148 {
 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);
 152
 153         dm_InitGPIOSetting(Adapter);
 154         pdmpriv->DM_Type = DM_Type_ByDriver;
 155         pdmpriv->DMFlag = DYNAMIC_FUNC_DISABLE;
 156         Update_ODM_ComInfo_88E(Adapter);
 157         ODM_DMInit(dm_odm);
 158         Adapter->fix_rate = 0xFF;
 159 }
 160
 161 void rtl8188e_HalDmWatchDog(struct adapter *Adapter)
 162 {
 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);
 167
 168         _func_enter_;
 169         hw_init_completed = Adapter->hw_init_completed;
 170
 171         if (!hw_init_completed)
 172                 goto skip_dm;
 173
 174         fw_cur_in_ps = Adapter->pwrctrlpriv.bFwCurrentInPSMode;
 175         rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&fw_ps_awake));
 176
 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)
 180                 fw_ps_awake = false;
 181
 182         if (hw_init_completed && ((!fw_cur_in_ps) && fw_ps_awake)) {
 183                 /*  Calculate Tx/Rx statistics. */
 184                 dm_CheckStatistics(Adapter);
 185
 186         _func_exit_;
 187         }
 188
 189         /* ODM */
 190         if (hw_init_completed) {
 191                 struct mlme_priv *pmlmepriv = &Adapter->mlmepriv;
 192                 u8 bLinked = false;
 193
 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)
 197                                 bLinked = true;
 198                 } else {/* Station mode */
 199                         if (check_fwstate(pmlmepriv, _FW_LINKED))
 200                                 bLinked = true;
 201                 }
 202
 203                 ODM_CmnInfoUpdate(&hal_data->odmpriv, ODM_CMNINFO_LINK, bLinked);
 204                 ODM_DMWatchdog(&hal_data->odmpriv);
 205         }
 206 skip_dm:
 207         /*  Check GPIO to determine current RF on/off and Pbc status. */
 208         /*  Check Hardware Radio ON/OFF or not */
 209         return;
 210 }
 211
 212 void rtl8188e_init_dm_priv(struct adapter *Adapter)
 213 {
 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;
 217
 218         _rtw_memset(pdmpriv, 0, sizeof(struct dm_priv));
 219         Init_ODM_ComInfo_88E(Adapter);
 220         ODM_InitDebugSetting(podmpriv);
 221 }
 222
 223 void rtl8188e_deinit_dm_priv(struct adapter *Adapter)
 224 {
 225 }
 226
 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)
 230 {
 231         struct hal_data_8188e *hal_data = GET_HAL_DATA(Adapter);
 232
 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;
 238                 }
 239         }
 240 }
 241
 242 /*  Add new function to reset the state of antenna diversity before link. */
 243 u8 AntDivBeforeLink8188E(struct adapter *Adapter)
 244 {
 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);
 249
 250         /*  Condition that does not need to use antenna diversity. */
 251         if (hal_data->AntDivCfg == 0)
 252                 return false;
 253
 254         if (check_fwstate(pmlmepriv, _FW_LINKED))
 255                 return false;
 256
 257         if (dm_swat_tbl->SWAS_NoLink_State == 0) {
 258                 /* switch channel */
 259                 dm_swat_tbl->SWAS_NoLink_State = 1;
 260                 dm_swat_tbl->CurAntenna = (dm_swat_tbl->CurAntenna == Antenna_A) ? Antenna_B : Antenna_A;
 261
 262                 rtw_antenna_select_cmd(Adapter, dm_swat_tbl->CurAntenna, false);
 263                 return true;
 264         } else {
 265                 dm_swat_tbl->SWAS_NoLink_State = 0;
 266                 return false;
 267         }
 268 }