1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
3 * rtl871x_ioctl_set.c
4 *
5 * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
6 * Linux device driver for RTL8192SU
7 *
8 * Modifications for inclusion into the Linux staging tree are
9 * Copyright(c) 2010 Larry Finger. All rights reserved.
10 *
11 * Contact information:
12 * WLAN FAE <wlanfae@realtek.com>
13 * Larry Finger <Larry.Finger@lwfinger.net>
14 *
15 ******************************************************************************/
16
17 #define _RTL871X_IOCTL_SET_C_
18
19 #include "osdep_service.h"
20 #include "drv_types.h"
21 #include "rtl871x_ioctl_set.h"
22 #include "usb_osintf.h"
23 #include "usb_ops.h"
24
25
validate_ssid(struct ndis_802_11_ssid * ssid)26 static u8 validate_ssid(struct ndis_802_11_ssid *ssid)
27 {
28 u8 i;
29
30 if (ssid->SsidLength > 32)
31 return false;
32 for (i = 0; i < ssid->SsidLength; i++) {
33 /* wifi, printable ascii code must be supported */
34 if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e)))
35 return false;
36 }
37 return true;
38 }
39
do_join(struct _adapter * padapter)40 static u8 do_join(struct _adapter *padapter)
41 {
42 struct list_head *plist, *phead;
43 u8 *pibss = NULL;
44 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
45 struct __queue *queue = &(pmlmepriv->scanned_queue);
46 int ret;
47
48 phead = &queue->queue;
49 plist = phead->next;
50 pmlmepriv->cur_network.join_res = -2;
51 pmlmepriv->fw_state |= _FW_UNDER_LINKING;
52 pmlmepriv->pscanned = plist;
53 pmlmepriv->to_join = true;
54
55 /* adhoc mode will start with an empty queue, but skip checking */
56 if (!check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) &&
57 list_empty(&queue->queue)) {
58 if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
59 pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
60 /* when set_ssid/set_bssid for do_join(), but scanning queue
61 * is empty we try to issue sitesurvey firstly
62 */
63 if (!pmlmepriv->sitesurveyctrl.traffic_busy)
64 r8712_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid);
65 return true;
66 }
67
68 ret = r8712_select_and_join_from_scan(pmlmepriv);
69 if (!ret) {
70 mod_timer(&pmlmepriv->assoc_timer,
71 jiffies + msecs_to_jiffies(MAX_JOIN_TIMEOUT));
72 } else {
73 if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
74 /* submit r8712_createbss_cmd to change to an
75 * ADHOC_MASTER pmlmepriv->lock has been
76 * acquired by caller...
77 */
78 struct wlan_bssid_ex *pdev_network =
79 &(padapter->registrypriv.dev_network);
80 pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;
81 pibss = padapter->registrypriv.dev_network.MacAddress;
82 memcpy(&pdev_network->Ssid,
83 &pmlmepriv->assoc_ssid,
84 sizeof(struct ndis_802_11_ssid));
85 r8712_update_registrypriv_dev_network(padapter);
86 r8712_generate_random_ibss(pibss);
87 if (r8712_createbss_cmd(padapter))
88 return false;
89 pmlmepriv->to_join = false;
90 } else {
91 /* can't associate ; reset under-linking */
92 if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
93 pmlmepriv->fw_state ^=
94 _FW_UNDER_LINKING;
95 /* when set_ssid/set_bssid for do_join(), but
96 * there are no desired bss in scanning queue
97 * we try to issue sitesurvey first
98 */
99 if (!pmlmepriv->sitesurveyctrl.traffic_busy)
100 r8712_sitesurvey_cmd(padapter,
101 &pmlmepriv->assoc_ssid);
102 }
103 }
104 return true;
105 }
106
r8712_set_802_11_bssid(struct _adapter * padapter,u8 * bssid)107 u8 r8712_set_802_11_bssid(struct _adapter *padapter, u8 *bssid)
108 {
109 unsigned long irqL;
110 u8 status = true;
111 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
112
113 if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid)) {
114 status = false;
115 return status;
116 }
117 spin_lock_irqsave(&pmlmepriv->lock, irqL);
118 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY |
119 _FW_UNDER_LINKING)) {
120 status = check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
121 goto _Abort_Set_BSSID;
122 }
123 if (check_fwstate(pmlmepriv,
124 _FW_LINKED | WIFI_ADHOC_MASTER_STATE)) {
125 if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid,
126 ETH_ALEN)) {
127 if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE))
128 /* driver is in
129 * WIFI_ADHOC_MASTER_STATE
130 */
131 goto _Abort_Set_BSSID;
132 } else {
133 r8712_disassoc_cmd(padapter);
134 if (check_fwstate(pmlmepriv, _FW_LINKED))
135 r8712_ind_disconnect(padapter);
136 r8712_free_assoc_resources(padapter);
137 if ((check_fwstate(pmlmepriv,
138 WIFI_ADHOC_MASTER_STATE))) {
139 _clr_fwstate_(pmlmepriv,
140 WIFI_ADHOC_MASTER_STATE);
141 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
142 }
143 }
144 }
145 memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
146 pmlmepriv->assoc_by_bssid = true;
147 status = do_join(padapter);
148 goto done;
149 _Abort_Set_BSSID:
150 done:
151 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
152 return status;
153 }
154
r8712_set_802_11_ssid(struct _adapter * padapter,struct ndis_802_11_ssid * ssid)155 void r8712_set_802_11_ssid(struct _adapter *padapter,
156 struct ndis_802_11_ssid *ssid)
157 {
158 unsigned long irqL;
159 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
160 struct wlan_network *pnetwork = &pmlmepriv->cur_network;
161
162 if (!padapter->hw_init_completed)
163 return;
164 spin_lock_irqsave(&pmlmepriv->lock, irqL);
165 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING)) {
166 check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
167 goto _Abort_Set_SSID;
168 }
169 if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE)) {
170 if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) &&
171 (!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid,
172 ssid->SsidLength))) {
173 if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE)) {
174 if (!r8712_is_same_ibss(padapter,
175 pnetwork)) {
176 /* if in WIFI_ADHOC_MASTER_STATE or
177 * WIFI_ADHOC_STATE, create bss or
178 * rejoin again
179 */
180 r8712_disassoc_cmd(padapter);
181 if (check_fwstate(pmlmepriv,
182 _FW_LINKED))
183 r8712_ind_disconnect(padapter);
184 r8712_free_assoc_resources(padapter);
185 if (check_fwstate(pmlmepriv,
186 WIFI_ADHOC_MASTER_STATE)) {
187 _clr_fwstate_(pmlmepriv,
188 WIFI_ADHOC_MASTER_STATE);
189 set_fwstate(pmlmepriv,
190 WIFI_ADHOC_STATE);
191 }
192 } else {
193 /* driver is in
194 * WIFI_ADHOC_MASTER_STATE
195 */
196 goto _Abort_Set_SSID;
197 }
198 }
199 } else {
200 r8712_disassoc_cmd(padapter);
201 if (check_fwstate(pmlmepriv, _FW_LINKED))
202 r8712_ind_disconnect(padapter);
203 r8712_free_assoc_resources(padapter);
204 if (check_fwstate(pmlmepriv,
205 WIFI_ADHOC_MASTER_STATE)) {
206 _clr_fwstate_(pmlmepriv,
207 WIFI_ADHOC_MASTER_STATE);
208 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
209 }
210 }
211 }
212 if (padapter->securitypriv.btkip_countermeasure)
213 goto _Abort_Set_SSID;
214 if (!validate_ssid(ssid))
215 goto _Abort_Set_SSID;
216 memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
217 pmlmepriv->assoc_by_bssid = false;
218 do_join(padapter);
219 goto done;
220 _Abort_Set_SSID:
221 done:
222 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
223 }
224
r8712_set_802_11_infrastructure_mode(struct _adapter * padapter,enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)225 void r8712_set_802_11_infrastructure_mode(struct _adapter *padapter,
226 enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
227 {
228 unsigned long irqL;
229 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
230 struct wlan_network *cur_network = &pmlmepriv->cur_network;
231 enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state =
232 &(cur_network->network.InfrastructureMode);
233
234 if (*pold_state != networktype) {
235 spin_lock_irqsave(&pmlmepriv->lock, irqL);
236 if (check_fwstate(pmlmepriv, _FW_LINKED) ||
237 (*pold_state == Ndis802_11IBSS))
238 r8712_disassoc_cmd(padapter);
239 if (check_fwstate(pmlmepriv,
240 _FW_LINKED | WIFI_ADHOC_MASTER_STATE))
241 r8712_free_assoc_resources(padapter);
242 if (check_fwstate(pmlmepriv, _FW_LINKED) ||
243 (*pold_state == Ndis802_11Infrastructure) ||
244 (*pold_state == Ndis802_11IBSS)) {
245 /* will clr Linked_state before this function,
246 * we must have checked whether issue dis-assoc_cmd or
247 * not
248 */
249 r8712_ind_disconnect(padapter);
250 }
251 *pold_state = networktype;
252 /* clear WIFI_STATION_STATE; WIFI_AP_STATE; WIFI_ADHOC_STATE;
253 * WIFI_ADHOC_MASTER_STATE
254 */
255 _clr_fwstate_(pmlmepriv, WIFI_STATION_STATE | WIFI_AP_STATE |
256 WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE);
257 switch (networktype) {
258 case Ndis802_11IBSS:
259 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
260 break;
261 case Ndis802_11Infrastructure:
262 set_fwstate(pmlmepriv, WIFI_STATION_STATE);
263 break;
264 case Ndis802_11APMode:
265 set_fwstate(pmlmepriv, WIFI_AP_STATE);
266 break;
267 case Ndis802_11AutoUnknown:
268 case Ndis802_11InfrastructureMax:
269 break;
270 }
271 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
272 }
273 }
274
r8712_set_802_11_disassociate(struct _adapter * padapter)275 u8 r8712_set_802_11_disassociate(struct _adapter *padapter)
276 {
277 unsigned long irqL;
278 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
279
280 spin_lock_irqsave(&pmlmepriv->lock, irqL);
281 if (check_fwstate(pmlmepriv, _FW_LINKED)) {
282 r8712_disassoc_cmd(padapter);
283 r8712_ind_disconnect(padapter);
284 r8712_free_assoc_resources(padapter);
285 }
286 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
287 return true;
288 }
289
r8712_set_802_11_bssid_list_scan(struct _adapter * padapter)290 u8 r8712_set_802_11_bssid_list_scan(struct _adapter *padapter)
291 {
292 struct mlme_priv *pmlmepriv = NULL;
293 unsigned long irqL;
294 u8 ret = true;
295
296 if (!padapter)
297 return false;
298 pmlmepriv = &padapter->mlmepriv;
299 if (!padapter->hw_init_completed)
300 return false;
301 spin_lock_irqsave(&pmlmepriv->lock, irqL);
302 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) ||
303 pmlmepriv->sitesurveyctrl.traffic_busy) {
304 /* Scan or linking is in progress, do nothing. */
305 ret = (u8)check_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
306 } else {
307 r8712_free_network_queue(padapter);
308 ret = r8712_sitesurvey_cmd(padapter, NULL);
309 }
310 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
311 return ret;
312 }
313
r8712_set_802_11_authentication_mode(struct _adapter * padapter,enum NDIS_802_11_AUTHENTICATION_MODE authmode)314 u8 r8712_set_802_11_authentication_mode(struct _adapter *padapter,
315 enum NDIS_802_11_AUTHENTICATION_MODE authmode)
316 {
317 struct security_priv *psecuritypriv = &padapter->securitypriv;
318 u8 ret;
319
320 psecuritypriv->ndisauthtype = authmode;
321 if (psecuritypriv->ndisauthtype > 3)
322 psecuritypriv->AuthAlgrthm = 2; /* 802.1x */
323 if (r8712_set_auth(padapter, psecuritypriv))
324 ret = false;
325 else
326 ret = true;
327 return ret;
328 }
329
r8712_set_802_11_add_wep(struct _adapter * padapter,struct NDIS_802_11_WEP * wep)330 int r8712_set_802_11_add_wep(struct _adapter *padapter,
331 struct NDIS_802_11_WEP *wep)
332 {
333 sint keyid;
334 struct security_priv *psecuritypriv = &padapter->securitypriv;
335
336 keyid = wep->KeyIndex & 0x3fffffff;
337 if (keyid >= WEP_KEYS)
338 return -EINVAL;
339 switch (wep->KeyLength) {
340 case 5:
341 psecuritypriv->PrivacyAlgrthm = _WEP40_;
342 break;
343 case 13:
344 psecuritypriv->PrivacyAlgrthm = _WEP104_;
345 break;
346 default:
347 psecuritypriv->PrivacyAlgrthm = _NO_PRIVACY_;
348 break;
349 }
350 memcpy(psecuritypriv->DefKey[keyid].skey, &wep->KeyMaterial,
351 wep->KeyLength);
352 psecuritypriv->DefKeylen[keyid] = wep->KeyLength;
353 psecuritypriv->PrivacyKeyIndex = keyid;
354 return r8712_set_key(padapter, psecuritypriv, keyid);
355 }
356