1 /******************************************************************************
2 *
3 * Copyright(c) 2007 - 2012 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 ******************************************************************************/
15
16 #include <rtw_sreset.h>
17 #include <usb_ops_linux.h>
18
rtw_sreset_init(struct rtw_adapter * padapter)19 void rtw_sreset_init(struct rtw_adapter *padapter)
20 {
21 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
22 struct sreset_priv *psrtpriv = &pHalData->srestpriv;
23
24 mutex_init(&psrtpriv->silentreset_mutex);
25 psrtpriv->silent_reset_inprogress = false;
26 psrtpriv->last_tx_time = 0;
27 psrtpriv->last_tx_complete_time = 0;
28 }
29
rtw_sreset_reset_value(struct rtw_adapter * padapter)30 void rtw_sreset_reset_value(struct rtw_adapter *padapter)
31 {
32 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
33 struct sreset_priv *psrtpriv = &pHalData->srestpriv;
34
35 psrtpriv->silent_reset_inprogress = false;
36 psrtpriv->last_tx_time = 0;
37 psrtpriv->last_tx_complete_time = 0;
38 }
39
rtw_sreset_inprogress(struct rtw_adapter * padapter)40 bool rtw_sreset_inprogress(struct rtw_adapter *padapter)
41 {
42 struct rtw_adapter *primary_adapter = GET_PRIMARY_ADAPTER(padapter);
43 struct hal_data_8723a *pHalData = GET_HAL_DATA(primary_adapter);
44
45 return pHalData->srestpriv.silent_reset_inprogress;
46 }
47
sreset_restore_security_station(struct rtw_adapter * padapter)48 static void sreset_restore_security_station(struct rtw_adapter *padapter)
49 {
50 struct mlme_priv *mlmepriv = &padapter->mlmepriv;
51 struct sta_priv *pstapriv = &padapter->stapriv;
52 struct sta_info *psta;
53 struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info;
54 u8 val8;
55
56 if (pmlmeinfo->auth_algo == dot11AuthAlgrthm_8021X)
57 val8 = 0xcc;
58 else
59 val8 = 0xcf;
60
61 rtl8723a_set_sec_cfg(padapter, val8);
62
63 if (padapter->securitypriv.dot11PrivacyAlgrthm ==
64 WLAN_CIPHER_SUITE_TKIP ||
65 padapter->securitypriv.dot11PrivacyAlgrthm ==
66 WLAN_CIPHER_SUITE_CCMP) {
67 psta = rtw_get_stainfo23a(pstapriv, get_bssid(mlmepriv));
68 if (psta == NULL) {
69 /* DEBUG_ERR(("Set wpa_set_encryption: Obtain Sta_info fail\n")); */
70 } else {
71 /* pairwise key */
72 rtw_setstakey_cmd23a(padapter, (unsigned char *)psta, true);
73 /* group key */
74 rtw_set_key23a(padapter,&padapter->securitypriv, padapter->securitypriv.dot118021XGrpKeyid, 0);
75 }
76 }
77 }
78
sreset_restore_network_station(struct rtw_adapter * padapter)79 static void sreset_restore_network_station(struct rtw_adapter *padapter)
80 {
81 struct mlme_priv *mlmepriv = &padapter->mlmepriv;
82 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
83 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
84 u8 threshold;
85
86 rtw_setopmode_cmd23a(padapter, NL80211_IFTYPE_STATION);
87
88 /* TH = 1 => means that invalidate usb rx aggregation */
89 /* TH = 0 => means that validate usb rx aggregation, use init value. */
90 if (mlmepriv->htpriv.ht_option) {
91 if (padapter->registrypriv.wifi_spec == 1)
92 threshold = 1;
93 else
94 threshold = 0;
95 } else
96 threshold = 1;
97
98 rtl8723a_set_rxdma_agg_pg_th(padapter, threshold);
99
100 set_channel_bwmode23a(padapter, pmlmeext->cur_channel,
101 pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode);
102
103 hw_var_set_bssid(padapter, pmlmeinfo->network.MacAddress);
104 hw_var_set_mlme_join(padapter, 0);
105
106 rtl8723a_set_media_status(padapter, pmlmeinfo->state & 0x3);
107
108 mlmeext_joinbss_event_callback23a(padapter, 1);
109 /* restore Sequence No. */
110 rtl8723au_write8(padapter, 0x4dc, padapter->xmitpriv.nqos_ssn);
111
112 sreset_restore_security_station(padapter);
113 }
114
sreset_restore_network_status(struct rtw_adapter * padapter)115 static void sreset_restore_network_status(struct rtw_adapter *padapter)
116 {
117 struct mlme_priv *mlmepriv = &padapter->mlmepriv;
118
119 if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) {
120 DBG_8723A("%s(%s): fwstate:0x%08x - WIFI_STATION_STATE\n",
121 __func__, padapter->pnetdev->name,
122 get_fwstate(mlmepriv));
123 sreset_restore_network_station(padapter);
124 #ifdef CONFIG_8723AU_AP_MODE
125 } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) {
126 DBG_8723A("%s(%s): fwstate:0x%08x - WIFI_AP_STATE\n",
127 __func__, padapter->pnetdev->name,
128 get_fwstate(mlmepriv));
129 rtw_ap_restore_network(padapter);
130 #endif
131 } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) {
132 DBG_8723A("%s(%s): fwstate:0x%08x - WIFI_ADHOC_STATE\n",
133 __func__, padapter->pnetdev->name,
134 get_fwstate(mlmepriv));
135 } else {
136 DBG_8723A("%s(%s): fwstate:0x%08x - ???\n", __func__,
137 padapter->pnetdev->name, get_fwstate(mlmepriv));
138 }
139 }
140
sreset_stop_adapter(struct rtw_adapter * padapter)141 static void sreset_stop_adapter(struct rtw_adapter *padapter)
142 {
143 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
144 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
145
146 if (padapter == NULL)
147 return;
148
149 DBG_8723A("%s(%s)\n", __func__, padapter->pnetdev->name);
150
151 if (!rtw_netif_queue_stopped(padapter->pnetdev))
152 netif_tx_stop_all_queues(padapter->pnetdev);
153
154 rtw_cancel_all_timer23a(padapter);
155
156 /* TODO: OS and HCI independent */
157 tasklet_kill(&pxmitpriv->xmit_tasklet);
158
159 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
160 rtw_scan_abort23a(padapter);
161
162 if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
163 rtw23a_join_to_handler((unsigned long)padapter);
164 }
165
sreset_start_adapter(struct rtw_adapter * padapter)166 static void sreset_start_adapter(struct rtw_adapter *padapter)
167 {
168 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
169 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
170
171 if (padapter == NULL)
172 return;
173
174 DBG_8723A("%s(%s)\n", __func__, padapter->pnetdev->name);
175
176 if (check_fwstate(pmlmepriv, _FW_LINKED))
177 sreset_restore_network_status(padapter);
178
179 /* TODO: OS and HCI independent */
180 tasklet_hi_schedule(&pxmitpriv->xmit_tasklet);
181
182 mod_timer(&padapter->mlmepriv.dynamic_chk_timer,
183 jiffies + msecs_to_jiffies(2000));
184
185 if (rtw_netif_queue_stopped(padapter->pnetdev))
186 netif_tx_wake_all_queues(padapter->pnetdev);
187 }
188
rtw_sreset_reset(struct rtw_adapter * active_adapter)189 void rtw_sreset_reset(struct rtw_adapter *active_adapter)
190 {
191 struct rtw_adapter *padapter = GET_PRIMARY_ADAPTER(active_adapter);
192 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
193 struct sreset_priv *psrtpriv = &pHalData->srestpriv;
194 struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
195 unsigned long start = jiffies;
196
197 DBG_8723A("%s\n", __func__);
198
199 mutex_lock(&psrtpriv->silentreset_mutex);
200 psrtpriv->silent_reset_inprogress = true;
201 pwrpriv->change_rfpwrstate = rf_off;
202
203 sreset_stop_adapter(padapter);
204
205 ips_enter23a(padapter);
206 ips_leave23a(padapter);
207
208 sreset_start_adapter(padapter);
209 psrtpriv->silent_reset_inprogress = false;
210 mutex_unlock(&psrtpriv->silentreset_mutex);
211
212 DBG_8723A("%s done in %d ms\n", __func__,
213 jiffies_to_msecs(jiffies - start));
214 }
215