1 /******************************************************************************
2 *
3 * Copyright(c) 2007 - 2017 Realtek Corporation.
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 *****************************************************************************/
15
16 #include <drv_types.h>
17 #include <hal_data.h>
18 #include <rtw_sreset.h>
19
sreset_init_value(_adapter * padapter)20 void sreset_init_value(_adapter *padapter)
21 {
22 #if defined(DBG_CONFIG_ERROR_DETECT)
23 HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
24 struct sreset_priv *psrtpriv = &pHalData->srestpriv;
25
26 _rtw_mutex_init(&psrtpriv->silentreset_mutex);
27 psrtpriv->silent_reset_inprogress = _FALSE;
28 psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;
29 psrtpriv->last_tx_time = 0;
30 psrtpriv->last_tx_complete_time = 0;
31 #endif
32 }
sreset_reset_value(_adapter * padapter)33 void sreset_reset_value(_adapter *padapter)
34 {
35 #if defined(DBG_CONFIG_ERROR_DETECT)
36 HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
37 struct sreset_priv *psrtpriv = &pHalData->srestpriv;
38
39 psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;
40 psrtpriv->last_tx_time = 0;
41 psrtpriv->last_tx_complete_time = 0;
42 #endif
43 }
44
sreset_get_wifi_status(_adapter * padapter)45 u8 sreset_get_wifi_status(_adapter *padapter)
46 {
47 #if defined(DBG_CONFIG_ERROR_DETECT)
48 HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
49 struct sreset_priv *psrtpriv = &pHalData->srestpriv;
50 u8 status = WIFI_STATUS_SUCCESS;
51 u32 val32 = 0;
52
53 if (psrtpriv->silent_reset_inprogress == _TRUE)
54 return status;
55 val32 = rtw_read32(padapter, REG_TXDMA_STATUS);
56 if (val32 == 0xeaeaeaea)
57 psrtpriv->Wifi_Error_Status = WIFI_IF_NOT_EXIST;
58 else if (val32 != 0) {
59 RTW_INFO("txdmastatu(%x)\n", val32);
60 psrtpriv->Wifi_Error_Status = WIFI_MAC_TXDMA_ERROR;
61 }
62
63 if (WIFI_STATUS_SUCCESS != psrtpriv->Wifi_Error_Status) {
64 RTW_INFO("==>%s error_status(0x%x)\n", __FUNCTION__, psrtpriv->Wifi_Error_Status);
65 status = (psrtpriv->Wifi_Error_Status & (~(USB_READ_PORT_FAIL | USB_WRITE_PORT_FAIL)));
66 }
67 RTW_INFO("==> %s wifi_status(0x%x)\n", __FUNCTION__, status);
68
69 /* status restore */
70 psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;
71
72 return status;
73 #else
74 return WIFI_STATUS_SUCCESS;
75 #endif
76 }
77
sreset_set_wifi_error_status(_adapter * padapter,u32 status)78 void sreset_set_wifi_error_status(_adapter *padapter, u32 status)
79 {
80 #if defined(DBG_CONFIG_ERROR_DETECT)
81 HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
82 pHalData->srestpriv.Wifi_Error_Status = status;
83 #endif
84 }
85
sreset_set_trigger_point(_adapter * padapter,s32 tgp)86 void sreset_set_trigger_point(_adapter *padapter, s32 tgp)
87 {
88 #if defined(DBG_CONFIG_ERROR_DETECT)
89 HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
90 pHalData->srestpriv.dbg_trigger_point = tgp;
91 #endif
92 }
93
sreset_inprogress(_adapter * padapter)94 bool sreset_inprogress(_adapter *padapter)
95 {
96 #if defined(DBG_CONFIG_ERROR_RESET)
97 HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
98 return pHalData->srestpriv.silent_reset_inprogress;
99 #else
100 return _FALSE;
101 #endif
102 }
103
sreset_restore_security_station(_adapter * padapter)104 void sreset_restore_security_station(_adapter *padapter)
105 {
106 struct mlme_priv *mlmepriv = &padapter->mlmepriv;
107 struct sta_priv *pstapriv = &padapter->stapriv;
108 struct sta_info *psta;
109 struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info;
110
111 {
112 u8 val8;
113
114 if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X) {
115 val8 = 0xcc;
116 #ifdef CONFIG_WAPI_SUPPORT
117 } else if (padapter->wapiInfo.bWapiEnable && pmlmeinfo->auth_algo == dot11AuthAlgrthm_WAPI) {
118 /* Disable TxUseDefaultKey, RxUseDefaultKey, RxBroadcastUseDefaultKey. */
119 val8 = 0x4c;
120 #endif
121 } else
122 val8 = 0xcf;
123 rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8));
124 }
125
126 if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) ||
127 (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) {
128 psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv));
129 if (psta == NULL) {
130 /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */
131 } else {
132 /* pairwise key */
133 rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _FALSE);
134 /* group key */
135 rtw_set_key(padapter, &padapter->securitypriv, padapter->securitypriv.dot118021XGrpKeyid, 0, _FALSE);
136 }
137 }
138 }
139
sreset_restore_network_station(_adapter * padapter)140 void sreset_restore_network_station(_adapter *padapter)
141 {
142 struct mlme_priv *mlmepriv = &padapter->mlmepriv;
143 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
144 struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
145 u8 doiqk = _FALSE;
146
147 rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, RTW_CMDF_DIRECTLY);
148
149 {
150 u8 threshold;
151 #ifdef CONFIG_USB_HCI
152 /* TH=1 => means that invalidate usb rx aggregation */
153 /* TH=0 => means that validate usb rx aggregation, use init value. */
154 #ifdef CONFIG_80211N_HT
155 if (mlmepriv->htpriv.ht_option) {
156 if (padapter->registrypriv.wifi_spec == 1)
157 threshold = 1;
158 else
159 threshold = 0;
160 rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold));
161 } else {
162 threshold = 1;
163 rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold));
164 }
165 #endif /* CONFIG_80211N_HT */
166 #endif
167 }
168
169 doiqk = _TRUE;
170 rtw_hal_set_hwreg(padapter, HW_VAR_DO_IQK , &doiqk);
171
172 set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode);
173
174 doiqk = _FALSE;
175 rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk);
176 /* disable dynamic functions, such as high power, DIG */
177 /*rtw_phydm_func_disable_all(padapter);*/
178
179 rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress);
180
181 {
182 u8 join_type = 0;
183
184 rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTING);
185 rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type));
186
187 rtw_btcoex_connect_notify(padapter, join_type);
188 }
189
190 Set_MSR(padapter, (pmlmeinfo->state & 0x3));
191
192 mlmeext_joinbss_event_callback(padapter, 1);
193 /* restore Sequence No. */
194 rtw_hal_set_hwreg(padapter, HW_VAR_RESTORE_HW_SEQ, 0);
195
196 sreset_restore_security_station(padapter);
197 }
198
199
sreset_restore_network_status(_adapter * padapter)200 void sreset_restore_network_status(_adapter *padapter)
201 {
202 struct mlme_priv *mlmepriv = &padapter->mlmepriv;
203
204 if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) {
205 RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv));
206 sreset_restore_network_station(padapter);
207 }
208 #ifdef CONFIG_AP_MODE
209 else if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) {
210 RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(padapter), MLME_IS_AP(padapter) ? "AP" : "MESH");
211 rtw_ap_restore_network(padapter);
212 }
213 #endif
214 else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE))
215 RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv));
216 else
217 RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv));
218 }
219
sreset_stop_adapter(_adapter * padapter)220 void sreset_stop_adapter(_adapter *padapter)
221 {
222 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
223 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
224
225 if (padapter == NULL)
226 return;
227
228 RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter));
229
230 rtw_netif_stop_queue(padapter->pnetdev);
231
232 rtw_cancel_all_timer(padapter);
233
234 /* TODO: OS and HCI independent */
235 #if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI)
236 tasklet_kill(&pxmitpriv->xmit_tasklet);
237 #endif
238
239 if (check_fwstate(pmlmepriv, WIFI_UNDER_SURVEY))
240 rtw_scan_abort(padapter);
241
242 if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING)) {
243 rtw_set_to_roam(padapter, 0);
244 rtw_join_timeout_handler(padapter);
245 }
246
247 }
248
sreset_start_adapter(_adapter * padapter)249 void sreset_start_adapter(_adapter *padapter)
250 {
251 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
252 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
253
254 if (padapter == NULL)
255 return;
256
257 RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter));
258
259 if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE))
260 sreset_restore_network_status(padapter);
261
262 /* TODO: OS and HCI independent */
263 #if defined(PLATFORM_LINUX) && defined(CONFIG_USB_HCI)
264 tasklet_hi_schedule(&pxmitpriv->xmit_tasklet);
265 #endif
266
267 if (is_primary_adapter(padapter))
268 _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000);
269
270 rtw_netif_wake_queue(padapter->pnetdev);
271 }
272
sreset_reset(_adapter * padapter)273 void sreset_reset(_adapter *padapter)
274 {
275 #ifdef DBG_CONFIG_ERROR_RESET
276 HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
277 struct sreset_priv *psrtpriv = &pHalData->srestpriv;
278 struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter);
279 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
280 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
281 _irqL irqL;
282 systime start = rtw_get_current_time();
283 struct dvobj_priv *psdpriv = padapter->dvobj;
284 struct debug_priv *pdbgpriv = &psdpriv->drv_dbg;
285
286 RTW_INFO("%s\n", __FUNCTION__);
287
288 psrtpriv->Wifi_Error_Status = WIFI_STATUS_SUCCESS;
289
290
291 #ifdef CONFIG_LPS
292 rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "SRESET");
293 #endif/* #ifdef CONFIG_LPS */
294
295 _enter_pwrlock(&pwrpriv->lock);
296
297 psrtpriv->silent_reset_inprogress = _TRUE;
298 pwrpriv->change_rfpwrstate = rf_off;
299
300 rtw_mi_sreset_adapter_hdl(padapter, _FALSE);/*sreset_stop_adapter*/
301 #ifdef CONFIG_IPS
302 _ips_enter(padapter);
303 _ips_leave(padapter);
304 #endif
305 #if defined(CONFIG_AP_MODE) && defined(CONFIG_CONCURRENT_MODE)
306 rtw_mi_ap_info_restore(padapter);
307 #endif
308 rtw_mi_sreset_adapter_hdl(padapter, _TRUE);/*sreset_start_adapter*/
309
310 psrtpriv->silent_reset_inprogress = _FALSE;
311
312 _exit_pwrlock(&pwrpriv->lock);
313
314 RTW_INFO("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start));
315 pdbgpriv->dbg_sreset_cnt++;
316
317 psrtpriv->self_dect_fw = _FALSE;
318 psrtpriv->rx_cnt = 0;
319 #endif
320 }
321