1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
3 *
4 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
5 *
6 ******************************************************************************/
7 #define _RTW_IOCTL_SET_C_
8
9 #include <osdep_service.h>
10 #include <drv_types.h>
11 #include <rtw_ioctl_set.h>
12 #include <hal_intf.h>
13
14 static const struct {
15 int channel_plan;
16 char *name;
17 } channel_table[] = { { RT_CHANNEL_DOMAIN_FCC, "US" },
18 { RT_CHANNEL_DOMAIN_ETSI, "EU" },
19 { RT_CHANNEL_DOMAIN_MKK, "JP" },
20 { RT_CHANNEL_DOMAIN_CHINA, "CN"} };
21
22 extern void indicate_wx_scan_complete_event(struct adapter *padapter);
23
rtw_do_join(struct adapter * padapter)24 u8 rtw_do_join(struct adapter *padapter)
25 {
26 struct list_head *plist, *phead;
27 u8 *pibss = NULL;
28 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
29 struct __queue *queue = &pmlmepriv->scanned_queue;
30 u8 ret = _SUCCESS;
31
32 spin_lock_bh(&pmlmepriv->scanned_queue.lock);
33 phead = get_list_head(queue);
34 plist = phead->next;
35
36 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("\n %s: phead = %p; plist = %p\n\n\n", __func__, phead, plist));
37
38 pmlmepriv->cur_network.join_res = -2;
39
40 set_fwstate(pmlmepriv, _FW_UNDER_LINKING);
41
42 pmlmepriv->pscanned = plist;
43
44 pmlmepriv->to_join = true;
45
46 if (list_empty(&queue->queue)) {
47 spin_unlock_bh(&pmlmepriv->scanned_queue.lock);
48 _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);
49
50 /* when set_ssid/set_bssid for rtw_do_join(), but scanning queue is empty */
51 /* we try to issue sitesurvey firstly */
52
53 if (!pmlmepriv->LinkDetectInfo.bBusyTraffic ||
54 pmlmepriv->to_roaming > 0) {
55 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("%s: site survey if scanned_queue is empty\n.", __func__));
56 /* submit site_survey_cmd */
57 ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0);
58 if (ret != _SUCCESS) {
59 pmlmepriv->to_join = false;
60 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("%s: site survey return error\n.", __func__));
61 }
62 } else {
63 pmlmepriv->to_join = false;
64 ret = _FAIL;
65 }
66
67 goto exit;
68 } else {
69 int select_ret;
70
71 spin_unlock_bh(&pmlmepriv->scanned_queue.lock);
72 select_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv);
73 if (select_ret == _SUCCESS) {
74 pmlmepriv->to_join = false;
75 mod_timer(&pmlmepriv->assoc_timer,
76 jiffies + msecs_to_jiffies(MAX_JOIN_TIMEOUT));
77 } else {
78 if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
79 /* submit createbss_cmd to change to a ADHOC_MASTER */
80
81 /* pmlmepriv->lock has been acquired by caller... */
82 struct wlan_bssid_ex *pdev_network = &padapter->registrypriv.dev_network;
83
84 pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;
85
86 pibss = padapter->registrypriv.dev_network.MacAddress;
87
88 memcpy(&pdev_network->ssid, &pmlmepriv->assoc_ssid, sizeof(struct ndis_802_11_ssid));
89
90 rtw_update_registrypriv_dev_network(padapter);
91
92 rtw_generate_random_ibss(pibss);
93
94 if (rtw_createbss_cmd(padapter) != _SUCCESS) {
95 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("***Error =>do_goin: rtw_createbss_cmd status FAIL***\n "));
96 ret = false;
97 goto exit;
98 }
99 pmlmepriv->to_join = false;
100
101 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
102 ("***Error => rtw_select_and_join_from_scanned_queue FAIL under STA_Mode***\n "));
103 } else {
104 /* can't associate ; reset under-linking */
105 _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING);
106
107 /* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */
108 /* we try to issue sitesurvey firstly */
109 if (!pmlmepriv->LinkDetectInfo.bBusyTraffic ||
110 pmlmepriv->to_roaming > 0) {
111 ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0);
112 if (ret != _SUCCESS) {
113 pmlmepriv->to_join = false;
114 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("do_join(): site survey return error\n."));
115 }
116 } else {
117 ret = _FAIL;
118 pmlmepriv->to_join = false;
119 }
120 }
121 }
122 }
123
124 exit:
125 return ret;
126 }
127
rtw_set_802_11_bssid(struct adapter * padapter,u8 * bssid)128 u8 rtw_set_802_11_bssid(struct adapter *padapter, u8 *bssid)
129 {
130 u8 status = _SUCCESS;
131 u32 cur_time = 0;
132 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
133
134 DBG_88E_LEVEL(_drv_info_, "set bssid:%pM\n", bssid);
135
136 if ((bssid[0] == 0x00 && bssid[1] == 0x00 && bssid[2] == 0x00 &&
137 bssid[3] == 0x00 && bssid[4] == 0x00 && bssid[5] == 0x00) ||
138 (bssid[0] == 0xFF && bssid[1] == 0xFF && bssid[2] == 0xFF &&
139 bssid[3] == 0xFF && bssid[4] == 0xFF && bssid[5] == 0xFF)) {
140 status = _FAIL;
141 goto exit;
142 }
143
144 spin_lock_bh(&pmlmepriv->lock);
145
146 DBG_88E("Set BSSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv));
147 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
148 goto handle_tkip_countermeasure;
149 else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
150 goto release_mlme_lock;
151
152 if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE)) {
153 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n"));
154
155 if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid, ETH_ALEN)) {
156 if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE))
157 goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */
158 } else {
159 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set BSSID not the same bssid\n"));
160 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_bssid =%pM\n", (bssid)));
161 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("cur_bssid =%pM\n", (pmlmepriv->cur_network.network.MacAddress)));
162
163 rtw_disassoc_cmd(padapter, 0, true);
164
165 if (check_fwstate(pmlmepriv, _FW_LINKED))
166 rtw_indicate_disconnect(padapter);
167
168 rtw_free_assoc_resources(padapter);
169
170 if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) {
171 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
172 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
173 }
174 }
175 }
176
177 handle_tkip_countermeasure:
178 /* should we add something here...? */
179
180 if (padapter->securitypriv.btkip_countermeasure) {
181 cur_time = jiffies;
182
183 if (cur_time - padapter->securitypriv.btkip_countermeasure_time > 60 * HZ) {
184 padapter->securitypriv.btkip_countermeasure = false;
185 padapter->securitypriv.btkip_countermeasure_time = 0;
186 } else {
187 status = _FAIL;
188 goto release_mlme_lock;
189 }
190 }
191
192 memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
193 pmlmepriv->assoc_by_bssid = true;
194
195 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
196 pmlmepriv->to_join = true;
197 else
198 status = rtw_do_join(padapter);
199
200 release_mlme_lock:
201 spin_unlock_bh(&pmlmepriv->lock);
202
203 exit:
204 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
205 ("%s: status=%d\n", __func__, status));
206
207 return status;
208 }
209
rtw_set_802_11_ssid(struct adapter * padapter,struct ndis_802_11_ssid * ssid)210 u8 rtw_set_802_11_ssid(struct adapter *padapter, struct ndis_802_11_ssid *ssid)
211 {
212 u8 status = _SUCCESS;
213 u32 cur_time = 0;
214
215 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
216 struct wlan_network *pnetwork = &pmlmepriv->cur_network;
217
218 DBG_88E_LEVEL(_drv_info_, "set ssid [%s] fw_state=0x%08x\n",
219 ssid->ssid, get_fwstate(pmlmepriv));
220
221 if (!padapter->hw_init_completed) {
222 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
223 ("set_ssid: hw_init_completed == false =>exit!!!\n"));
224 status = _FAIL;
225 goto exit;
226 }
227
228 spin_lock_bh(&pmlmepriv->lock);
229
230 DBG_88E("Set SSID under fw_state = 0x%08x\n", get_fwstate(pmlmepriv));
231 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
232 goto handle_tkip_countermeasure;
233 else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
234 goto release_mlme_lock;
235
236 if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE)) {
237 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
238 ("set_ssid: _FW_LINKED||WIFI_ADHOC_MASTER_STATE\n"));
239
240 if (pmlmepriv->assoc_ssid.ssid_length == ssid->ssid_length &&
241 !memcmp(&pmlmepriv->assoc_ssid.ssid, ssid->ssid, ssid->ssid_length)) {
242 if (!check_fwstate(pmlmepriv, WIFI_STATION_STATE)) {
243 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
244 ("Set SSID is the same ssid, fw_state = 0x%08x\n",
245 get_fwstate(pmlmepriv)));
246
247 if (!rtw_is_same_ibss(padapter, pnetwork)) {
248 /* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */
249 rtw_disassoc_cmd(padapter, 0, true);
250
251 if (check_fwstate(pmlmepriv, _FW_LINKED))
252 rtw_indicate_disconnect(padapter);
253
254 rtw_free_assoc_resources(padapter);
255
256 if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) {
257 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
258 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
259 }
260 } else {
261 goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */
262 }
263 } else {
264 rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1);
265 }
266 } else {
267 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("Set SSID not the same ssid\n"));
268 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("set_ssid =[%s] len = 0x%x\n", ssid->ssid, (unsigned int)ssid->ssid_length));
269 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("assoc_ssid =[%s] len = 0x%x\n", pmlmepriv->assoc_ssid.ssid, (unsigned int)pmlmepriv->assoc_ssid.ssid_length));
270
271 rtw_disassoc_cmd(padapter, 0, true);
272
273 if (check_fwstate(pmlmepriv, _FW_LINKED))
274 rtw_indicate_disconnect(padapter);
275
276 rtw_free_assoc_resources(padapter);
277
278 if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) {
279 _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE);
280 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
281 }
282 }
283 }
284
285 handle_tkip_countermeasure:
286
287 if (padapter->securitypriv.btkip_countermeasure) {
288 cur_time = jiffies;
289
290 if (cur_time - padapter->securitypriv.btkip_countermeasure_time > 60 * HZ) {
291 padapter->securitypriv.btkip_countermeasure = false;
292 padapter->securitypriv.btkip_countermeasure_time = 0;
293 } else {
294 status = _FAIL;
295 goto release_mlme_lock;
296 }
297 }
298
299 memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
300 pmlmepriv->assoc_by_bssid = false;
301
302 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
303 pmlmepriv->to_join = true;
304 else
305 status = rtw_do_join(padapter);
306
307 release_mlme_lock:
308 spin_unlock_bh(&pmlmepriv->lock);
309
310 exit:
311 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_,
312 ("-%s: status =%d\n", __func__, status));
313 return status;
314 }
315
rtw_set_802_11_infrastructure_mode(struct adapter * padapter,enum ndis_802_11_network_infra networktype)316 u8 rtw_set_802_11_infrastructure_mode(struct adapter *padapter,
317 enum ndis_802_11_network_infra networktype)
318 {
319 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
320 struct wlan_network *cur_network = &pmlmepriv->cur_network;
321 enum ndis_802_11_network_infra *pold_state = &cur_network->network.InfrastructureMode;
322
323 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_notice_,
324 ("+%s: old =%d new =%d fw_state = 0x%08x\n", __func__,
325 *pold_state, networktype, get_fwstate(pmlmepriv)));
326
327 if (*pold_state != networktype) {
328 spin_lock_bh(&pmlmepriv->lock);
329
330 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, (" change mode!"));
331 /* DBG_88E("change mode, old_mode =%d, new_mode =%d, fw_state = 0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); */
332
333 if (*pold_state == Ndis802_11APMode) {
334 /* change to other mode from Ndis802_11APMode */
335 cur_network->join_res = -1;
336
337 #ifdef CONFIG_88EU_AP_MODE
338 stop_ap_mode(padapter);
339 #endif
340 }
341
342 if (check_fwstate(pmlmepriv, _FW_LINKED) ||
343 *pold_state == Ndis802_11IBSS)
344 rtw_disassoc_cmd(padapter, 0, true);
345
346 if (check_fwstate(pmlmepriv, _FW_LINKED) ||
347 check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))
348 rtw_free_assoc_resources(padapter);
349
350 if (*pold_state == Ndis802_11Infrastructure ||
351 *pold_state == Ndis802_11IBSS) {
352 if (check_fwstate(pmlmepriv, _FW_LINKED))
353 rtw_indicate_disconnect(padapter); /* will clr Linked_state; before this function, we must have checked whether issue dis-assoc_cmd or not */
354 }
355
356 *pold_state = networktype;
357
358 _clr_fwstate_(pmlmepriv, ~WIFI_NULL_STATE);
359
360 switch (networktype) {
361 case Ndis802_11IBSS:
362 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
363 break;
364 case Ndis802_11Infrastructure:
365 set_fwstate(pmlmepriv, WIFI_STATION_STATE);
366 break;
367 case Ndis802_11APMode:
368 set_fwstate(pmlmepriv, WIFI_AP_STATE);
369 #ifdef CONFIG_88EU_AP_MODE
370 start_ap_mode(padapter);
371 #endif
372 break;
373 case Ndis802_11AutoUnknown:
374 case Ndis802_11InfrastructureMax:
375 break;
376 }
377 spin_unlock_bh(&pmlmepriv->lock);
378 }
379
380 return true;
381 }
382
rtw_set_802_11_disassociate(struct adapter * padapter)383 u8 rtw_set_802_11_disassociate(struct adapter *padapter)
384 {
385 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
386
387 spin_lock_bh(&pmlmepriv->lock);
388
389 if (check_fwstate(pmlmepriv, _FW_LINKED)) {
390 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
391 ("MgntActrtw_set_802_11_disassociate: rtw_indicate_disconnect\n"));
392
393 rtw_disassoc_cmd(padapter, 0, true);
394 rtw_indicate_disconnect(padapter);
395 rtw_free_assoc_resources(padapter);
396 rtw_pwr_wakeup(padapter);
397 }
398
399 spin_unlock_bh(&pmlmepriv->lock);
400
401 return true;
402 }
403
rtw_set_802_11_bssid_list_scan(struct adapter * padapter,struct ndis_802_11_ssid * pssid,int ssid_max_num)404 u8 rtw_set_802_11_bssid_list_scan(struct adapter *padapter, struct ndis_802_11_ssid *pssid, int ssid_max_num)
405 {
406 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
407 u8 res = true;
408
409 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("+%s(), fw_state =%x\n", __func__, get_fwstate(pmlmepriv)));
410
411 if (!padapter) {
412 res = false;
413 goto exit;
414 }
415 if (!padapter->hw_init_completed) {
416 res = false;
417 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n === %s:hw_init_completed == false ===\n", __func__));
418 goto exit;
419 }
420
421 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY | _FW_UNDER_LINKING) ||
422 pmlmepriv->LinkDetectInfo.bBusyTraffic) {
423 /* Scan or linking is in progress, do nothing. */
424 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("%s fail since fw_state = %x\n", __func__, get_fwstate(pmlmepriv)));
425 res = true;
426
427 if (check_fwstate(pmlmepriv,
428 _FW_UNDER_SURVEY | _FW_UNDER_LINKING))
429 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###_FW_UNDER_SURVEY|_FW_UNDER_LINKING\n\n"));
430 else
431 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("\n###pmlmepriv->sitesurveyctrl.traffic_busy == true\n\n"));
432
433 } else {
434 if (rtw_is_scan_deny(padapter)) {
435 DBG_88E(FUNC_ADPT_FMT": scan deny\n", FUNC_ADPT_ARG(padapter));
436 indicate_wx_scan_complete_event(padapter);
437 return _SUCCESS;
438 }
439
440 spin_lock_bh(&pmlmepriv->lock);
441
442 res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0);
443
444 spin_unlock_bh(&pmlmepriv->lock);
445 }
446 exit:
447 return res;
448 }
449
rtw_set_802_11_authentication_mode(struct adapter * padapter,enum ndis_802_11_auth_mode authmode)450 u8 rtw_set_802_11_authentication_mode(struct adapter *padapter, enum ndis_802_11_auth_mode authmode)
451 {
452 struct security_priv *psecuritypriv = &padapter->securitypriv;
453 int res;
454 u8 ret;
455
456 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
457 ("set_802_11_auth.mode(): mode =%x\n", authmode));
458
459 psecuritypriv->ndisauthtype = authmode;
460
461 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
462 ("%s:psecuritypriv->ndisauthtype=%d", __func__,
463 psecuritypriv->ndisauthtype));
464
465 if (psecuritypriv->ndisauthtype > 3)
466 psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X;
467
468 res = rtw_set_auth(padapter, psecuritypriv);
469
470 if (res == _SUCCESS)
471 ret = true;
472 else
473 ret = false;
474
475 return ret;
476 }
477
rtw_set_802_11_add_wep(struct adapter * padapter,struct ndis_802_11_wep * wep)478 u8 rtw_set_802_11_add_wep(struct adapter *padapter, struct ndis_802_11_wep *wep)
479 {
480 int keyid, res;
481 struct security_priv *psecuritypriv = &padapter->securitypriv;
482 u8 ret = _SUCCESS;
483
484 keyid = wep->KeyIndex & 0x3fffffff;
485
486 if (keyid >= 4) {
487 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_err_, ("MgntActrtw_set_802_11_add_wep:keyid>4 =>fail\n"));
488 ret = false;
489 goto exit;
490 }
491
492 switch (wep->KeyLength) {
493 case 5:
494 psecuritypriv->dot11PrivacyAlgrthm = _WEP40_;
495 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength = 5\n"));
496 break;
497 case 13:
498 psecuritypriv->dot11PrivacyAlgrthm = _WEP104_;
499 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength = 13\n"));
500 break;
501 default:
502 psecuritypriv->dot11PrivacyAlgrthm = _NO_PRIVACY_;
503 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_, ("MgntActrtw_set_802_11_add_wep:wep->KeyLength!= 5 or 13\n"));
504 break;
505 }
506 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
507 ("%s:before memcpy, wep->KeyLength = 0x%x wep->KeyIndex = 0x%x keyid =%x\n", __func__,
508 wep->KeyLength, wep->KeyIndex, keyid));
509
510 memcpy(&psecuritypriv->dot11DefKey[keyid].skey[0],
511 &wep->KeyMaterial, wep->KeyLength);
512
513 psecuritypriv->dot11DefKeylen[keyid] = wep->KeyLength;
514
515 psecuritypriv->dot11PrivacyKeyIndex = keyid;
516
517 RT_TRACE(_module_rtl871x_ioctl_set_c_, _drv_info_,
518 ("%s:security key material : %x %x %x %x %x %x %x %x %x %x %x %x %x\n", __func__,
519 psecuritypriv->dot11DefKey[keyid].skey[0],
520 psecuritypriv->dot11DefKey[keyid].skey[1],
521 psecuritypriv->dot11DefKey[keyid].skey[2],
522 psecuritypriv->dot11DefKey[keyid].skey[3],
523 psecuritypriv->dot11DefKey[keyid].skey[4],
524 psecuritypriv->dot11DefKey[keyid].skey[5],
525 psecuritypriv->dot11DefKey[keyid].skey[6],
526 psecuritypriv->dot11DefKey[keyid].skey[7],
527 psecuritypriv->dot11DefKey[keyid].skey[8],
528 psecuritypriv->dot11DefKey[keyid].skey[9],
529 psecuritypriv->dot11DefKey[keyid].skey[10],
530 psecuritypriv->dot11DefKey[keyid].skey[11],
531 psecuritypriv->dot11DefKey[keyid].skey[12]));
532
533 res = rtw_set_key(padapter, psecuritypriv, keyid, 1);
534
535 if (res == _FAIL)
536 ret = false;
537 exit:
538 return ret;
539 }
540
541 /* Return 0 or 100Kbps */
rtw_get_cur_max_rate(struct adapter * adapter)542 u16 rtw_get_cur_max_rate(struct adapter *adapter)
543 {
544 int i = 0;
545 u8 *p;
546 u16 rate = 0, max_rate = 0;
547 struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv;
548 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
549 struct registry_priv *pregistrypriv = &adapter->registrypriv;
550 struct mlme_priv *pmlmepriv = &adapter->mlmepriv;
551 struct wlan_bssid_ex *pcur_bss = &pmlmepriv->cur_network.network;
552 u8 bw_40MHz = 0, short_GI_20 = 0, short_GI_40 = 0;
553 u32 ht_ielen = 0;
554
555 if (!check_fwstate(pmlmepriv, _FW_LINKED) &&
556 !check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE))
557 return 0;
558
559 if (pmlmeext->cur_wireless_mode & (WIRELESS_11_24N | WIRELESS_11_5N)) {
560 p = rtw_get_ie(&pcur_bss->ies[12], WLAN_EID_HT_CAPABILITY,
561 &ht_ielen, pcur_bss->ie_length - 12);
562 if (p && ht_ielen > 0) {
563 /* cur_bwmod is updated by beacon, pmlmeinfo is updated by association response */
564 bw_40MHz = (pmlmeext->cur_bwmode && (HT_INFO_HT_PARAM_REC_TRANS_CHNL_WIDTH & pmlmeinfo->HT_info.infos[0])) ? 1 : 0;
565
566 short_GI_20 = (le16_to_cpu(pmlmeinfo->HT_caps.cap_info) & IEEE80211_HT_CAP_SGI_20) ? 1 : 0;
567 short_GI_40 = (le16_to_cpu(pmlmeinfo->HT_caps.cap_info) & IEEE80211_HT_CAP_SGI_40) ? 1 : 0;
568
569 max_rate = rtw_mcs_rate(
570 RF_1T1R,
571 bw_40MHz & pregistrypriv->cbw40_enable,
572 short_GI_20,
573 short_GI_40,
574 pmlmeinfo->HT_caps.mcs.rx_mask
575 );
576 }
577 } else {
578 while (pcur_bss->SupportedRates[i] != 0 &&
579 pcur_bss->SupportedRates[i] != 0xFF) {
580 rate = pcur_bss->SupportedRates[i] & 0x7F;
581 if (rate > max_rate)
582 max_rate = rate;
583 i++;
584 }
585
586 max_rate *= 5;
587 }
588
589 return max_rate;
590 }
591
592 /* Return _SUCCESS or _FAIL */
rtw_set_country(struct adapter * adapter,const char * country_code)593 int rtw_set_country(struct adapter *adapter, const char *country_code)
594 {
595 int i;
596 int channel_plan = RT_CHANNEL_DOMAIN_WORLD_WIDE_5G;
597
598 DBG_88E("%s country_code:%s\n", __func__, country_code);
599 for (i = 0; i < ARRAY_SIZE(channel_table); i++) {
600 if (strcmp(channel_table[i].name, country_code) == 0) {
601 channel_plan = channel_table[i].channel_plan;
602 break;
603 }
604 }
605
606 if (i == ARRAY_SIZE(channel_table))
607 DBG_88E("%s unknown country_code:%s\n", __func__, country_code);
608
609 return rtw_set_chplan_cmd(adapter, channel_plan, 1);
610 }
611