Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 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 | * |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 14 | ******************************************************************************/ |
| 15 | /* */ |
| 16 | /* Description: */ |
| 17 | /* */ |
| 18 | /* This file is for 92CE/92CU dynamic mechanism only */ |
| 19 | /* */ |
| 20 | /* */ |
| 21 | /* */ |
| 22 | #define _RTL8188E_DM_C_ |
| 23 | |
| 24 | #include <osdep_service.h> |
| 25 | #include <drv_types.h> |
| 26 | |
| 27 | #include <rtl8188e_hal.h> |
| 28 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 29 | /* Initialize GPIO setting registers */ |
| 30 | static void dm_InitGPIOSetting(struct adapter *Adapter) |
| 31 | { |
| 32 | u8 tmp1byte; |
| 33 | |
navin patidar | c7b2e99 | 2014-06-11 22:51:36 +0530 | [diff] [blame] | 34 | tmp1byte = usb_read8(Adapter, REG_GPIO_MUXCFG); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 35 | tmp1byte &= (GPIOSEL_GPIO | ~GPIOSEL_ENBT); |
| 36 | |
navin patidar | e76484d | 2014-06-11 22:51:33 +0530 | [diff] [blame] | 37 | usb_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 38 | } |
| 39 | |
| 40 | /* */ |
| 41 | /* functions */ |
| 42 | /* */ |
| 43 | static void Init_ODM_ComInfo_88E(struct adapter *Adapter) |
| 44 | { |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 45 | struct hal_data_8188e *hal_data = Adapter->HalData; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 46 | struct dm_priv *pdmpriv = &hal_data->dmpriv; |
| 47 | struct odm_dm_struct *dm_odm = &(hal_data->odmpriv); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 48 | |
| 49 | /* Init Value */ |
navin patidar | 1ce3984 | 2014-06-22 13:49:28 +0530 | [diff] [blame] | 50 | memset(dm_odm, 0, sizeof(*dm_odm)); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 51 | |
| 52 | dm_odm->Adapter = Adapter; |
Ivan Safonov | d7c952a | 2016-09-16 21:34:12 +0700 | [diff] [blame] | 53 | dm_odm->SupportPlatform = ODM_CE; |
| 54 | dm_odm->SupportICType = ODM_RTL8188E; |
| 55 | dm_odm->CutVersion = ODM_CUT_A; |
| 56 | dm_odm->bIsMPChip = hal_data->VersionID.ChipType == NORMAL_CHIP; |
| 57 | dm_odm->PatchID = hal_data->CustomerID; |
| 58 | dm_odm->bWIFITest = Adapter->registrypriv.wifi_spec; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 59 | |
Ivan Safonov | d7c952a | 2016-09-16 21:34:12 +0700 | [diff] [blame] | 60 | dm_odm->AntDivType = hal_data->TRxAntDivType; |
| 61 | |
| 62 | /* Tx power tracking BB swing table. */ |
| 63 | /* The base index = 12. +((12-n)/2)dB 13~?? = decrease tx pwr by -((n-12)/2)dB */ |
| 64 | dm_odm->BbSwingIdxOfdm = 12; /* Set defalut value as index 12. */ |
| 65 | dm_odm->BbSwingIdxOfdmCurrent = 12; |
| 66 | dm_odm->BbSwingFlagOfdm = false; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 67 | |
| 68 | pdmpriv->InitODMFlag = ODM_RF_CALIBRATION | |
| 69 | ODM_RF_TX_PWR_TRACK; |
| 70 | |
Ivan Safonov | 7399c2c | 2016-09-16 21:33:12 +0700 | [diff] [blame] | 71 | dm_odm->SupportAbility = pdmpriv->InitODMFlag; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 72 | } |
| 73 | |
| 74 | static void Update_ODM_ComInfo_88E(struct adapter *Adapter) |
| 75 | { |
| 76 | struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; |
| 77 | struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; |
| 78 | struct pwrctrl_priv *pwrctrlpriv = &Adapter->pwrctrlpriv; |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 79 | struct hal_data_8188e *hal_data = Adapter->HalData; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 80 | struct odm_dm_struct *dm_odm = &(hal_data->odmpriv); |
| 81 | struct dm_priv *pdmpriv = &hal_data->dmpriv; |
| 82 | int i; |
| 83 | |
| 84 | pdmpriv->InitODMFlag = ODM_BB_DIG | |
| 85 | ODM_BB_RA_MASK | |
| 86 | ODM_BB_DYNAMIC_TXPWR | |
| 87 | ODM_BB_FA_CNT | |
| 88 | ODM_BB_RSSI_MONITOR | |
| 89 | ODM_BB_CCK_PD | |
| 90 | ODM_BB_PWR_SAVE | |
| 91 | ODM_MAC_EDCA_TURBO | |
| 92 | ODM_RF_CALIBRATION | |
| 93 | ODM_RF_TX_PWR_TRACK; |
| 94 | if (hal_data->AntDivCfg) |
| 95 | pdmpriv->InitODMFlag |= ODM_BB_ANT_DIV; |
| 96 | |
| 97 | if (Adapter->registrypriv.mp_mode == 1) { |
| 98 | pdmpriv->InitODMFlag = ODM_RF_CALIBRATION | |
| 99 | ODM_RF_TX_PWR_TRACK; |
| 100 | } |
| 101 | |
Ivan Safonov | 7399c2c | 2016-09-16 21:33:12 +0700 | [diff] [blame] | 102 | dm_odm->SupportAbility = pdmpriv->InitODMFlag; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 103 | |
Ivan Safonov | 02f14ca | 2016-09-16 21:33:42 +0700 | [diff] [blame] | 104 | dm_odm->pNumTxBytesUnicast = &Adapter->xmitpriv.tx_bytes; |
| 105 | dm_odm->pNumRxBytesUnicast = &Adapter->recvpriv.rx_bytes; |
| 106 | dm_odm->pWirelessMode = &pmlmeext->cur_wireless_mode; |
| 107 | dm_odm->pSecChOffset = &hal_data->nCur40MhzPrimeSC; |
| 108 | dm_odm->pSecurity = (u8 *)&Adapter->securitypriv.dot11PrivacyAlgrthm; |
| 109 | dm_odm->pBandWidth = (u8 *)&hal_data->CurrentChannelBW; |
| 110 | dm_odm->pChannel = &hal_data->CurrentChannel; |
| 111 | dm_odm->pbNet_closed = (bool *)&Adapter->net_closed; |
| 112 | dm_odm->mp_mode = &Adapter->registrypriv.mp_mode; |
| 113 | dm_odm->pbScanInProcess = (bool *)&pmlmepriv->bScanInProcess; |
| 114 | dm_odm->pbPowerSaving = (bool *)&pwrctrlpriv->bpower_saving; |
Ivan Safonov | d7c952a | 2016-09-16 21:34:12 +0700 | [diff] [blame] | 115 | dm_odm->AntDivType = hal_data->TRxAntDivType; |
| 116 | |
| 117 | /* Tx power tracking BB swing table. */ |
| 118 | /* The base index = 12. +((12-n)/2)dB 13~?? = decrease tx pwr by -((n-12)/2)dB */ |
| 119 | dm_odm->BbSwingIdxOfdm = 12; /* Set defalut value as index 12. */ |
| 120 | dm_odm->BbSwingIdxOfdmCurrent = 12; |
| 121 | dm_odm->BbSwingFlagOfdm = false; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 122 | |
| 123 | for (i = 0; i < NUM_STA; i++) |
| 124 | ODM_CmnInfoPtrArrayHook(dm_odm, ODM_CMNINFO_STA_STATUS, i, NULL); |
| 125 | } |
| 126 | |
| 127 | void rtl8188e_InitHalDm(struct adapter *Adapter) |
| 128 | { |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 129 | struct dm_priv *pdmpriv = &Adapter->HalData->dmpriv; |
| 130 | struct odm_dm_struct *dm_odm = &(Adapter->HalData->odmpriv); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 131 | |
| 132 | dm_InitGPIOSetting(Adapter); |
| 133 | pdmpriv->DM_Type = DM_Type_ByDriver; |
| 134 | pdmpriv->DMFlag = DYNAMIC_FUNC_DISABLE; |
| 135 | Update_ODM_ComInfo_88E(Adapter); |
| 136 | ODM_DMInit(dm_odm); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 137 | } |
| 138 | |
Ivan Safonov | 66fa5a4 | 2016-09-03 22:33:22 +0700 | [diff] [blame] | 139 | void rtw_hal_dm_watchdog(struct adapter *Adapter) |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 140 | { |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 141 | u8 hw_init_completed = false; |
Sudip Mukherjee | d48037f | 2014-11-07 16:50:46 +0530 | [diff] [blame] | 142 | struct mlme_priv *pmlmepriv = NULL; |
| 143 | u8 bLinked = false; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 144 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 145 | hw_init_completed = Adapter->hw_init_completed; |
| 146 | |
| 147 | if (!hw_init_completed) |
| 148 | goto skip_dm; |
| 149 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 150 | /* ODM */ |
Sudip Mukherjee | d48037f | 2014-11-07 16:50:46 +0530 | [diff] [blame] | 151 | pmlmepriv = &Adapter->mlmepriv; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 152 | |
Sudip Mukherjee | d48037f | 2014-11-07 16:50:46 +0530 | [diff] [blame] | 153 | if ((check_fwstate(pmlmepriv, WIFI_AP_STATE)) || |
| 154 | (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | |
| 155 | WIFI_ADHOC_MASTER_STATE))) { |
| 156 | if (Adapter->stapriv.asoc_sta_count > 2) |
| 157 | bLinked = true; |
| 158 | } else {/* Station mode */ |
| 159 | if (check_fwstate(pmlmepriv, _FW_LINKED)) |
| 160 | bLinked = true; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 161 | } |
Sudip Mukherjee | d48037f | 2014-11-07 16:50:46 +0530 | [diff] [blame] | 162 | |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 163 | Adapter->HalData->odmpriv.bLinked = bLinked; |
| 164 | ODM_DMWatchdog(&Adapter->HalData->odmpriv); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 165 | skip_dm: |
| 166 | /* Check GPIO to determine current RF on/off and Pbc status. */ |
| 167 | /* Check Hardware Radio ON/OFF or not */ |
| 168 | return; |
| 169 | } |
| 170 | |
Ivan Safonov | a5c25874 | 2016-09-03 22:33:37 +0700 | [diff] [blame] | 171 | void rtw_hal_dm_init(struct adapter *Adapter) |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 172 | { |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 173 | struct dm_priv *pdmpriv = &Adapter->HalData->dmpriv; |
| 174 | struct odm_dm_struct *podmpriv = &Adapter->HalData->odmpriv; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 175 | |
navin patidar | 1ce3984 | 2014-06-22 13:49:28 +0530 | [diff] [blame] | 176 | memset(pdmpriv, 0, sizeof(struct dm_priv)); |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 177 | Init_ODM_ComInfo_88E(Adapter); |
| 178 | ODM_InitDebugSetting(podmpriv); |
| 179 | } |
| 180 | |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 181 | /* Add new function to reset the state of antenna diversity before link. */ |
| 182 | /* Compare RSSI for deciding antenna */ |
Ivan Safonov | 2865af3 | 2016-09-03 22:33:11 +0700 | [diff] [blame] | 183 | void rtw_hal_antdiv_rssi_compared(struct adapter *Adapter, struct wlan_bssid_ex *dst, struct wlan_bssid_ex *src) |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 184 | { |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 185 | if (0 != Adapter->HalData->AntDivCfg) { |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 186 | /* select optimum_antenna for before linked =>For antenna diversity */ |
| 187 | if (dst->Rssi >= src->Rssi) {/* keep org parameter */ |
| 188 | src->Rssi = dst->Rssi; |
| 189 | src->PhyInfo.Optimum_antenna = dst->PhyInfo.Optimum_antenna; |
| 190 | } |
| 191 | } |
| 192 | } |
| 193 | |
| 194 | /* Add new function to reset the state of antenna diversity before link. */ |
Ivan Safonov | 1e24579 | 2016-09-03 22:33:15 +0700 | [diff] [blame] | 195 | u8 rtw_hal_antdiv_before_linked(struct adapter *Adapter) |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 196 | { |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 197 | struct odm_dm_struct *dm_odm = &Adapter->HalData->odmpriv; |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 198 | struct sw_ant_switch *dm_swat_tbl = &dm_odm->DM_SWAT_Table; |
| 199 | struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); |
| 200 | |
| 201 | /* Condition that does not need to use antenna diversity. */ |
Ivan Safonov | 177aa53 | 2016-09-19 00:28:06 +0700 | [diff] [blame] | 202 | if (Adapter->HalData->AntDivCfg == 0) |
Larry Finger | 7ef8ded | 2013-08-21 22:33:55 -0500 | [diff] [blame] | 203 | return false; |
| 204 | |
| 205 | if (check_fwstate(pmlmepriv, _FW_LINKED)) |
| 206 | return false; |
| 207 | |
| 208 | if (dm_swat_tbl->SWAS_NoLink_State == 0) { |
| 209 | /* switch channel */ |
| 210 | dm_swat_tbl->SWAS_NoLink_State = 1; |
| 211 | dm_swat_tbl->CurAntenna = (dm_swat_tbl->CurAntenna == Antenna_A) ? Antenna_B : Antenna_A; |
| 212 | |
| 213 | rtw_antenna_select_cmd(Adapter, dm_swat_tbl->CurAntenna, false); |
| 214 | return true; |
| 215 | } else { |
| 216 | dm_swat_tbl->SWAS_NoLink_State = 0; |
| 217 | return false; |
| 218 | } |
| 219 | } |