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