]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/staging/rtl8723au/core/rtw_wlan_util.c
Staging: rtl8192 Clean up function definition
[mirror_ubuntu-artful-kernel.git] / drivers / staging / rtl8723au / core / rtw_wlan_util.c
CommitLineData
5e93f352
LF
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#define _RTW_WLAN_UTIL_C_
16
17#include <osdep_service.h>
18#include <drv_types.h>
19#include <linux/ieee80211.h>
20#include <wifi.h>
6ec26273 21#include <rtl8723a_spec.h>
5e93f352
LF
22
23static unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f};
24static unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74};
25
26static unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18};
27static unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7};
28
29static unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96};
30static unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43};
31static unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43};
32static unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c};
33static unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5};
34static unsigned char EPIGRAM_OUI[] = {0x00, 0x90, 0x4c};
35
78717782
JS
36static unsigned char WPA_TKIP_CIPHER[4] = {0x00, 0x50, 0xf2, 0x02};
37static unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02};
38
c227ed0a 39#define R2T_PHY_DELAY 0
5e93f352 40
c227ed0a
JS
41/* define WAIT_FOR_BCN_TO_MIN 3000 */
42#define WAIT_FOR_BCN_TO_MIN 6000
43#define WAIT_FOR_BCN_TO_MAX 20000
5e93f352
LF
44
45static u8 rtw_basic_rate_cck[4] = {
c227ed0a
JS
46 IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK,
47 IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK,
48 IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK,
49 IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK
5e93f352
LF
50};
51
52static u8 rtw_basic_rate_ofdm[3] = {
c227ed0a
JS
53 IEEE80211_OFDM_RATE_6MB | IEEE80211_BASIC_RATE_MASK,
54 IEEE80211_OFDM_RATE_12MB | IEEE80211_BASIC_RATE_MASK,
55 IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK
5e93f352
LF
56};
57
58static u8 rtw_basic_rate_mix[7] = {
c227ed0a
JS
59 IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK,
60 IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK,
61 IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK,
62 IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK,
63 IEEE80211_OFDM_RATE_6MB | IEEE80211_BASIC_RATE_MASK,
64 IEEE80211_OFDM_RATE_12MB | IEEE80211_BASIC_RATE_MASK,
65 IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK
5e93f352
LF
66};
67
68int cckrates_included23a(unsigned char *rate, int ratelen)
69{
70 int i;
71
72 for (i = 0; i < ratelen; i++) {
c227ed0a
JS
73 if (((rate[i]) & 0x7f) == 2 || ((rate[i]) & 0x7f) == 4 ||
74 ((rate[i]) & 0x7f) == 11 || ((rate[i]) & 0x7f) == 22)
5e93f352
LF
75 return true;
76 }
77
78 return false;
79}
80
81int cckratesonly_included23a(unsigned char *rate, int ratelen)
82{
83 int i;
84
85 for (i = 0; i < ratelen; i++) {
c227ed0a
JS
86 if (((rate[i]) & 0x7f) != 2 && ((rate[i]) & 0x7f) != 4 &&
87 ((rate[i]) & 0x7f) != 11 && ((rate[i]) & 0x7f) != 22)
5e93f352
LF
88 return false;
89 }
90
91 return true;
92}
93
94unsigned char networktype_to_raid23a(unsigned char network_type)
95{
96 unsigned char raid;
97
98 switch (network_type) {
99 case WIRELESS_11B:
100 raid = RATR_INX_WIRELESS_B;
101 break;
102 case WIRELESS_11A:
103 case WIRELESS_11G:
104 raid = RATR_INX_WIRELESS_G;
105 break;
106 case WIRELESS_11BG:
107 raid = RATR_INX_WIRELESS_GB;
108 break;
109 case WIRELESS_11_24N:
110 case WIRELESS_11_5N:
111 raid = RATR_INX_WIRELESS_N;
112 break;
113 case WIRELESS_11A_5N:
114 case WIRELESS_11G_24N:
115 raid = RATR_INX_WIRELESS_NG;
116 break;
117 case WIRELESS_11BG_24N:
118 raid = RATR_INX_WIRELESS_NGB;
119 break;
120 default:
121 raid = RATR_INX_WIRELESS_GB;
122 break;
123 }
124 return raid;
125}
126
c227ed0a
JS
127u8 judge_network_type23a(struct rtw_adapter *padapter,
128 unsigned char *rate, int ratelen)
5e93f352
LF
129{
130 u8 network_type = 0;
c227ed0a 131 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
132 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
133
134 if (pmlmeext->cur_channel > 14) {
135 if (pmlmeinfo->HT_enable)
136 network_type = WIRELESS_11_5N;
137 network_type |= WIRELESS_11A;
138 } else {
139 if (pmlmeinfo->HT_enable)
140 network_type = WIRELESS_11_24N;
141
142 if ((cckratesonly_included23a(rate, ratelen)) == true)
143 network_type |= WIRELESS_11B;
144 else if ((cckrates_included23a(rate, ratelen)) == true)
145 network_type |= WIRELESS_11BG;
146 else
147 network_type |= WIRELESS_11G;
148 }
149 return network_type;
150}
151
c0b99bed 152static unsigned char ratetbl_val_2wifirate(unsigned char rate)
5e93f352
LF
153{
154 unsigned char val = 0;
155
156 switch (rate & 0x7f) {
157 case 0:
158 val = IEEE80211_CCK_RATE_1MB;
159 break;
160 case 1:
161 val = IEEE80211_CCK_RATE_2MB;
162 break;
163 case 2:
164 val = IEEE80211_CCK_RATE_5MB;
165 break;
166 case 3:
167 val = IEEE80211_CCK_RATE_11MB;
168 break;
169 case 4:
170 val = IEEE80211_OFDM_RATE_6MB;
171 break;
172 case 5:
173 val = IEEE80211_OFDM_RATE_9MB;
174 break;
175 case 6:
176 val = IEEE80211_OFDM_RATE_12MB;
177 break;
178 case 7:
179 val = IEEE80211_OFDM_RATE_18MB;
180 break;
181 case 8:
182 val = IEEE80211_OFDM_RATE_24MB;
183 break;
184 case 9:
185 val = IEEE80211_OFDM_RATE_36MB;
186 break;
187 case 10:
188 val = IEEE80211_OFDM_RATE_48MB;
189 break;
190 case 11:
191 val = IEEE80211_OFDM_RATE_54MB;
192 break;
193 }
194 return val;
195}
196
c0b99bed 197static int is_basicrate(struct rtw_adapter *padapter, unsigned char rate)
5e93f352
LF
198{
199 int i;
200 unsigned char val;
201 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
202
203 for (i = 0; i < NumRates; i++) {
204 val = pmlmeext->basicrate[i];
205
c227ed0a 206 if (val != 0xff && val != 0xfe) {
5e93f352
LF
207 if (rate == ratetbl_val_2wifirate(val))
208 return true;
209 }
210 }
211
212 return false;
213}
214
c0b99bed
LF
215static unsigned int ratetbl2rateset(struct rtw_adapter *padapter,
216 unsigned char *rateset)
5e93f352
LF
217{
218 int i;
219 unsigned char rate;
c227ed0a 220 unsigned int len = 0;
5e93f352
LF
221 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
222
223 for (i = 0; i < NumRates; i++) {
224 rate = pmlmeext->datarate[i];
225
226 switch (rate) {
227 case 0xff:
228 return len;
229 case 0xfe:
230 continue;
231 default:
232 rate = ratetbl_val_2wifirate(rate);
233
234 if (is_basicrate(padapter, rate) == true)
235 rate |= IEEE80211_BASIC_RATE_MASK;
236
237 rateset[len] = rate;
238 len++;
239 break;
240 }
241 }
242 return len;
243}
244
c227ed0a
JS
245void get_rate_set23a(struct rtw_adapter *padapter,
246 unsigned char *pbssrate, int *bssrate_len)
5e93f352
LF
247{
248 unsigned char supportedrates[NumRates];
249
250 memset(supportedrates, 0, NumRates);
251 *bssrate_len = ratetbl2rateset(padapter, supportedrates);
252 memcpy(pbssrate, supportedrates, *bssrate_len);
253}
254
255void UpdateBrateTbl23a(struct rtw_adapter *Adapter, u8 *mBratesOS)
256{
c227ed0a
JS
257 u8 i;
258 u8 rate;
5e93f352
LF
259
260 /* 1M, 2M, 5.5M, 11M, 6M, 12M, 24M are mandatory. */
261 for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) {
262 rate = mBratesOS[i] & 0x7f;
263 switch (rate) {
264 case IEEE80211_CCK_RATE_1MB:
265 case IEEE80211_CCK_RATE_2MB:
266 case IEEE80211_CCK_RATE_5MB:
267 case IEEE80211_CCK_RATE_11MB:
268 case IEEE80211_OFDM_RATE_6MB:
269 case IEEE80211_OFDM_RATE_12MB:
270 case IEEE80211_OFDM_RATE_24MB:
271 mBratesOS[i] |= IEEE80211_BASIC_RATE_MASK;
272 break;
273 default:
274 break;
275 }
276 }
277}
278
279void Update23aTblForSoftAP(u8 *bssrateset, u32 bssratelen)
280{
c227ed0a
JS
281 u8 i;
282 u8 rate;
5e93f352
LF
283
284 for (i = 0; i < bssratelen; i++) {
285 rate = bssrateset[i] & 0x7f;
286 switch (rate) {
287 case IEEE80211_CCK_RATE_1MB:
288 case IEEE80211_CCK_RATE_2MB:
289 case IEEE80211_CCK_RATE_5MB:
290 case IEEE80211_CCK_RATE_11MB:
291 bssrateset[i] |= IEEE80211_BASIC_RATE_MASK;
292 break;
293 }
294 }
295}
296
5e93f352
LF
297inline u8 rtw_get_oper_ch23a(struct rtw_adapter *adapter)
298{
299 return adapter_to_dvobj(adapter)->oper_channel;
300}
301
302inline void rtw_set_oper_ch23a(struct rtw_adapter *adapter, u8 ch)
303{
304 adapter_to_dvobj(adapter)->oper_channel = ch;
305}
306
307inline u8 rtw_get_oper_bw23a(struct rtw_adapter *adapter)
308{
309 return adapter_to_dvobj(adapter)->oper_bwmode;
310}
311
312inline void rtw_set_oper_bw23a(struct rtw_adapter *adapter, u8 bw)
313{
314 adapter_to_dvobj(adapter)->oper_bwmode = bw;
315}
316
317inline u8 rtw_get_oper_ch23aoffset(struct rtw_adapter *adapter)
318{
319 return adapter_to_dvobj(adapter)->oper_ch_offset;
320}
321
322inline void rtw_set_oper_ch23aoffset23a(struct rtw_adapter *adapter, u8 offset)
323{
324 adapter_to_dvobj(adapter)->oper_ch_offset = offset;
325}
326
327void SelectChannel23a(struct rtw_adapter *padapter, unsigned char channel)
328{
329 mutex_lock(&adapter_to_dvobj(padapter)->setch_mutex);
330
331 /* saved channel info */
332 rtw_set_oper_ch23a(padapter, channel);
333
8a6f555f 334 PHY_SwChnl8723A(padapter, channel);
5e93f352
LF
335
336 mutex_unlock(&adapter_to_dvobj(padapter)->setch_mutex);
337}
338
9b0cb4b6
JS
339static void set_bwmode(struct rtw_adapter *padapter, unsigned short bwmode,
340 unsigned char channel_offset)
5e93f352
LF
341{
342 mutex_lock(&adapter_to_dvobj(padapter)->setbw_mutex);
343
344 /* saved bw info */
345 rtw_set_oper_bw23a(padapter, bwmode);
346 rtw_set_oper_ch23aoffset23a(padapter, channel_offset);
347
8a6f555f
JS
348 PHY_SetBWMode23a8723A(padapter, (enum ht_channel_width)bwmode,
349 channel_offset);
5e93f352
LF
350
351 mutex_unlock(&adapter_to_dvobj(padapter)->setbw_mutex);
352}
353
354void set_channel_bwmode23a(struct rtw_adapter *padapter, unsigned char channel,
a82b4b01 355 unsigned char channel_offset, unsigned short bwmode)
5e93f352
LF
356{
357 u8 center_ch;
358
c227ed0a
JS
359 if (bwmode == HT_CHANNEL_WIDTH_20 ||
360 channel_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) {
5e93f352
LF
361 /* SelectChannel23a(padapter, channel); */
362 center_ch = channel;
363 } else {
364 /* switch to the proper channel */
365 if (channel_offset == HAL_PRIME_CHNL_OFFSET_LOWER) {
366 /* SelectChannel23a(padapter, channel + 2); */
367 center_ch = channel + 2;
368 } else {
369 /* SelectChannel23a(padapter, channel - 2); */
370 center_ch = channel - 2;
371 }
372 }
373
374 /* set Channel */
375 mutex_lock(&adapter_to_dvobj(padapter)->setch_mutex);
376
377 /* saved channel/bw info */
378 rtw_set_oper_ch23a(padapter, channel);
379 rtw_set_oper_bw23a(padapter, bwmode);
380 rtw_set_oper_ch23aoffset23a(padapter, channel_offset);
381
8a6f555f 382 PHY_SwChnl8723A(padapter, center_ch); /* set center channel */
5e93f352
LF
383
384 mutex_unlock(&adapter_to_dvobj(padapter)->setch_mutex);
385
9b0cb4b6 386 set_bwmode(padapter, bwmode, channel_offset);
5e93f352
LF
387}
388
5e93f352
LF
389inline u8 *get_my_bssid23a(struct wlan_bssid_ex *pnetwork)
390{
391 return pnetwork->MacAddress;
392}
393
f6fe0a41 394bool is_client_associated_to_ap23a(struct rtw_adapter *padapter)
5e93f352 395{
c227ed0a
JS
396 struct mlme_ext_priv *pmlmeext;
397 struct mlme_ext_info *pmlmeinfo;
5e93f352
LF
398
399 if (!padapter)
f6fe0a41 400 return false;
5e93f352
LF
401
402 pmlmeext = &padapter->mlmeextpriv;
403 pmlmeinfo = &pmlmeext->mlmext_info;
404
c227ed0a 405 if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS &&
6ec26273 406 (pmlmeinfo->state & 0x03) == MSR_INFRA)
5e93f352
LF
407 return true;
408 else
f6fe0a41 409 return false;
5e93f352
LF
410}
411
f6fe0a41 412bool is_client_associated_to_ibss23a(struct rtw_adapter *padapter)
5e93f352 413{
c227ed0a 414 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
415 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
416
c227ed0a 417 if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS &&
6ec26273 418 (pmlmeinfo->state & 0x03) == MSR_ADHOC)
5e93f352
LF
419 return true;
420 else
f6fe0a41 421 return false;
5e93f352
LF
422}
423
f6fe0a41 424bool is_IBSS_empty23a(struct rtw_adapter *padapter)
5e93f352
LF
425{
426 unsigned int i;
c227ed0a 427 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
428 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
429
430 for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) {
431 if (pmlmeinfo->FW_sta_info[i].status == 1)
f6fe0a41 432 return false;
5e93f352
LF
433 }
434
435 return true;
436}
437
438unsigned int decide_wait_for_beacon_timeout23a(unsigned int bcn_interval)
439{
440 if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN)
441 return WAIT_FOR_BCN_TO_MIN;
442 else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX)
443 return WAIT_FOR_BCN_TO_MAX;
444 else
445 return bcn_interval << 2;
446}
447
5e93f352
LF
448void clear_cam_entry23a(struct rtw_adapter *padapter, u8 entry)
449{
450 unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
451
c227ed0a
JS
452 unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
453 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
454 0x00, 0x00, 0x00, 0x00};
5e93f352 455
dc0d16a1 456 rtl8723a_cam_write(padapter, entry, 0, null_sta, null_key);
5e93f352
LF
457}
458
459int allocate_fw_sta_entry23a(struct rtw_adapter *padapter)
460{
461 unsigned int mac_id;
c227ed0a 462 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
463 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
464
465 for (mac_id = IBSS_START_MAC_ID; mac_id < NUM_STA; mac_id++) {
466 if (pmlmeinfo->FW_sta_info[mac_id].status == 0) {
467 pmlmeinfo->FW_sta_info[mac_id].status = 1;
468 pmlmeinfo->FW_sta_info[mac_id].retry = 0;
469 break;
470 }
471 }
472
473 return mac_id;
474}
475
476void flush_all_cam_entry23a(struct rtw_adapter *padapter)
477{
c227ed0a 478 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
479 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
480
2a3bc8aa 481 rtl8723a_cam_invalidate_all(padapter);
5e93f352 482
c227ed0a 483 memset(pmlmeinfo->FW_sta_info, 0, sizeof(pmlmeinfo->FW_sta_info));
5e93f352
LF
484}
485
3cdf2773 486int WMM_param_handler23a(struct rtw_adapter *padapter, const u8 *p)
5e93f352
LF
487{
488 /* struct registry_priv *pregpriv = &padapter->registrypriv; */
489 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
c227ed0a 490 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
491 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
492
bd8ad4a5 493 if (pmlmepriv->qos_option == 0) {
5e93f352
LF
494 pmlmeinfo->WMM_enable = 0;
495 return _FAIL;
496 }
497
498 pmlmeinfo->WMM_enable = 1;
b171da3c 499 memcpy(&pmlmeinfo->WMM_param, p + 2 + 6,
5e93f352
LF
500 sizeof(struct WMM_para_element));
501 return true;
502}
503
504void WMMOnAssocRsp23a(struct rtw_adapter *padapter)
505{
c227ed0a
JS
506 u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime;
507 u8 acm_mask;
508 u16 TXOP;
509 u32 acParm, i;
510 u32 edca[4], inx[4];
511 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352 512 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
c227ed0a
JS
513 struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
514 struct registry_priv *pregpriv = &padapter->registrypriv;
5e93f352
LF
515
516 if (pmlmeinfo->WMM_enable == 0) {
517 padapter->mlmepriv.acm_mask = 0;
518 return;
519 }
520
521 acm_mask = 0;
522
523 if (pmlmeext->cur_wireless_mode == WIRELESS_11B)
524 aSifsTime = 10;
525 else
526 aSifsTime = 16;
527
528 for (i = 0; i < 4; i++) {
529 ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03;
530 ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01;
531
532 /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */
c227ed0a
JS
533 AIFS = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN & 0x0f) *
534 pmlmeinfo->slotTime + aSifsTime;
5e93f352 535
c227ed0a 536 ECWMin = pmlmeinfo->WMM_param.ac_param[i].CW & 0x0f;
5e93f352
LF
537 ECWMax = (pmlmeinfo->WMM_param.ac_param[i].CW & 0xf0) >> 4;
538 TXOP = le16_to_cpu(pmlmeinfo->WMM_param.ac_param[i].TXOP_limit);
539
540 acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16);
541
542 switch (ACI) {
543 case 0x0:
2487205e 544 rtl8723a_set_ac_param_be(padapter, acParm);
5e93f352
LF
545 acm_mask |= (ACM? BIT(1):0);
546 edca[XMIT_BE_QUEUE] = acParm;
547 break;
548 case 0x1:
2487205e 549 rtl8723a_set_ac_param_bk(padapter, acParm);
5e93f352
LF
550 /* acm_mask |= (ACM? BIT(0):0); */
551 edca[XMIT_BK_QUEUE] = acParm;
552 break;
553 case 0x2:
2487205e 554 rtl8723a_set_ac_param_vi(padapter, acParm);
5e93f352
LF
555 acm_mask |= (ACM? BIT(2):0);
556 edca[XMIT_VI_QUEUE] = acParm;
557 break;
558 case 0x3:
2487205e 559 rtl8723a_set_ac_param_vo(padapter, acParm);
5e93f352
LF
560 acm_mask |= (ACM? BIT(3):0);
561 edca[XMIT_VO_QUEUE] = acParm;
562 break;
563 }
564
565 DBG_8723A("WMM(%x): %x, %x\n", ACI, ACM, acParm);
566 }
567
568 if (padapter->registrypriv.acm_method == 1)
d5cdb9e1 569 rtl8723a_set_acm_ctrl(padapter, acm_mask);
5e93f352
LF
570 else
571 padapter->mlmepriv.acm_mask = acm_mask;
572
573 inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3;
574
575 if (pregpriv->wifi_spec == 1) {
c227ed0a 576 u32 j, tmp, change_inx = false;
5e93f352
LF
577
578 /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */
579 for (i = 0; i < 4; i++) {
580 for (j = i+1; j < 4; j++) {
581 /* compare CW and AIFS */
582 if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) {
583 change_inx = true;
c227ed0a
JS
584 } else if ((edca[j] & 0xFFFF) ==
585 (edca[i] & 0xFFFF)) {
5e93f352
LF
586 /* compare TXOP */
587 if ((edca[j] >> 16) > (edca[i] >> 16))
588 change_inx = true;
589 }
590
591 if (change_inx) {
592 tmp = edca[i];
593 edca[i] = edca[j];
594 edca[j] = tmp;
595
596 tmp = inx[i];
597 inx[i] = inx[j];
598 inx[j] = tmp;
599
600 change_inx = false;
601 }
602 }
603 }
604 }
605
606 for (i = 0; i<4; i++) {
607 pxmitpriv->wmm_para_seq[i] = inx[i];
c227ed0a
JS
608 DBG_8723A("wmm_para_seq(%d): %d\n", i,
609 pxmitpriv->wmm_para_seq[i]);
5e93f352 610 }
5e93f352
LF
611}
612
7882ef45 613static void bwmode_update_check(struct rtw_adapter *padapter, const u8 *p)
5e93f352 614{
4dc5f8ba 615 struct ieee80211_ht_operation *pHT_info;
5e93f352 616 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
c227ed0a 617 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
618 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
619 struct registry_priv *pregistrypriv = &padapter->registrypriv;
c227ed0a
JS
620 struct ht_priv *phtpriv = &pmlmepriv->htpriv;
621 unsigned char new_bwmode;
622 unsigned char new_ch_offset;
5e93f352 623
b171da3c 624 if (!p)
5e93f352
LF
625 return;
626 if (!phtpriv->ht_option)
627 return;
4dc5f8ba 628 if (p[1] != sizeof(struct ieee80211_ht_operation))
5e93f352
LF
629 return;
630
4dc5f8ba 631 pHT_info = (struct ieee80211_ht_operation *)(p + 2);
5e93f352 632
4dc5f8ba
JS
633 if ((pHT_info->ht_param & IEEE80211_HT_PARAM_CHAN_WIDTH_ANY) &&
634 pregistrypriv->cbw40_enable) {
5e93f352
LF
635 new_bwmode = HT_CHANNEL_WIDTH_40;
636
4dc5f8ba
JS
637 switch (pHT_info->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET){
638 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
5e93f352
LF
639 new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER;
640 break;
4dc5f8ba 641 case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
5e93f352
LF
642 new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER;
643 break;
644 default:
645 new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
646 break;
647 }
648 } else {
649 new_bwmode = HT_CHANNEL_WIDTH_20;
650 new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
651 }
652
c227ed0a
JS
653 if (new_bwmode != pmlmeext->cur_bwmode ||
654 new_ch_offset != pmlmeext->cur_ch_offset) {
5e93f352
LF
655 pmlmeinfo->bwmode_updated = true;
656
657 pmlmeext->cur_bwmode = new_bwmode;
658 pmlmeext->cur_ch_offset = new_ch_offset;
659
660 /* update HT info also */
b171da3c 661 HT_info_handler23a(padapter, p);
c227ed0a 662 } else
5e93f352 663 pmlmeinfo->bwmode_updated = false;
5e93f352
LF
664
665 if (pmlmeinfo->bwmode_updated) {
666 struct sta_info *psta;
667 struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
668 struct sta_priv *pstapriv = &padapter->stapriv;
669
c227ed0a
JS
670 /* set_channel_bwmode23a(padapter, pmlmeext->cur_channel,
671 pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
5e93f352
LF
672
673 /* update ap's stainfo */
674 psta = rtw_get_stainfo23a(pstapriv, cur_network->MacAddress);
675 if (psta) {
c227ed0a 676 struct ht_priv *phtpriv_sta = &psta->htpriv;
5e93f352
LF
677
678 if (phtpriv_sta->ht_option) {
679 /* bwmode */
680 phtpriv_sta->bwmode = pmlmeext->cur_bwmode;
c227ed0a
JS
681 phtpriv_sta->ch_offset =
682 pmlmeext->cur_ch_offset;
5e93f352
LF
683 } else {
684 phtpriv_sta->bwmode = HT_CHANNEL_WIDTH_20;
c227ed0a
JS
685 phtpriv_sta->ch_offset =
686 HAL_PRIME_CHNL_OFFSET_DONT_CARE;
5e93f352 687 }
5e93f352
LF
688 }
689 }
690}
691
3cdf2773 692void HT_caps_handler23a(struct rtw_adapter *padapter, const u8 *p)
5e93f352 693{
c227ed0a
JS
694 unsigned int i;
695 u8 rf_type;
696 u8 max_AMPDU_len, min_MPDU_spacing;
697 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352 698 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
c227ed0a
JS
699 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
700 struct ht_priv *phtpriv = &pmlmepriv->htpriv;
65be27da
JS
701 struct ieee80211_ht_cap *cap;
702 u8 *dstcap;
5e93f352 703
b171da3c 704 if (!p)
c227ed0a 705 return;
5e93f352 706
6a5f657d 707 if (!phtpriv->ht_option)
c227ed0a 708 return;
5e93f352
LF
709
710 pmlmeinfo->HT_caps_enable = 1;
711
65be27da
JS
712 cap = &pmlmeinfo->ht_cap;
713 dstcap = (u8 *)cap;
b171da3c 714 for (i = 0; i < p[1]; i++) {
5e93f352 715 if (i != 2) {
65be27da 716 dstcap[i] &= p[i + 2];
5e93f352
LF
717 } else {
718 /* modify from fw by Thomas 2010/11/17 */
65be27da
JS
719 if ((cap->ampdu_params_info &
720 IEEE80211_HT_AMPDU_PARM_FACTOR) >
721 (p[i + 2] & IEEE80211_HT_AMPDU_PARM_FACTOR))
722 max_AMPDU_len = p[i + 2] &
723 IEEE80211_HT_AMPDU_PARM_FACTOR;
5e93f352 724 else
65be27da
JS
725 max_AMPDU_len = cap->ampdu_params_info &
726 IEEE80211_HT_AMPDU_PARM_FACTOR;
727
728 if ((cap->ampdu_params_info &
729 IEEE80211_HT_AMPDU_PARM_DENSITY) >
730 (p[i + 2] & IEEE80211_HT_AMPDU_PARM_DENSITY))
731 min_MPDU_spacing = cap->ampdu_params_info &
732 IEEE80211_HT_AMPDU_PARM_DENSITY;
5e93f352 733 else
65be27da
JS
734 min_MPDU_spacing = p[i + 2] &
735 IEEE80211_HT_AMPDU_PARM_DENSITY;
5e93f352 736
65be27da 737 cap->ampdu_params_info =
b171da3c 738 max_AMPDU_len | min_MPDU_spacing;
5e93f352
LF
739 }
740 }
741
c2370e83 742 rf_type = rtl8723a_get_rf_type(padapter);
5e93f352
LF
743
744 /* update the MCS rates */
198e95d5 745 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
c227ed0a 746 if (rf_type == RF_1T1R || rf_type == RF_1T2R)
65be27da 747 cap->mcs.rx_mask[i] &= MCS_rate_1R23A[i];
5e93f352 748 else
65be27da 749 cap->mcs.rx_mask[i] &= MCS_rate_2R23A[i];
5e93f352 750 }
5e93f352
LF
751}
752
7882ef45 753void HT_info_handler23a(struct rtw_adapter *padapter, const u8 *p)
5e93f352 754{
c227ed0a 755 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352 756 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
c227ed0a
JS
757 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
758 struct ht_priv *phtpriv = &pmlmepriv->htpriv;
5e93f352 759
b171da3c 760 if (!p)
c227ed0a 761 return;
5e93f352 762
6a5f657d 763 if (!phtpriv->ht_option)
c227ed0a 764 return;
5e93f352 765
4dc5f8ba 766 if (p[1] != sizeof(struct ieee80211_ht_operation))
5e93f352
LF
767 return;
768
769 pmlmeinfo->HT_info_enable = 1;
b171da3c 770 memcpy(&pmlmeinfo->HT_info, p + 2, p[1]);
5e93f352
LF
771}
772
773void HTOnAssocRsp23a(struct rtw_adapter *padapter)
774{
c227ed0a
JS
775 unsigned char max_AMPDU_len;
776 unsigned char min_MPDU_spacing;
5e93f352 777 /* struct registry_priv *pregpriv = &padapter->registrypriv; */
c227ed0a 778 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
779 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
780
781 DBG_8723A("%s\n", __func__);
782
c227ed0a 783 if (pmlmeinfo->HT_info_enable && pmlmeinfo->HT_caps_enable)
5e93f352 784 pmlmeinfo->HT_enable = 1;
c227ed0a 785 else {
5e93f352 786 pmlmeinfo->HT_enable = 0;
c227ed0a
JS
787 /* set_channel_bwmode23a(padapter, pmlmeext->cur_channel,
788 pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
5e93f352
LF
789 return;
790 }
791
792 /* handle A-MPDU parameter field */
793 /*
794 AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k
795 AMPDU_para [4:2]:Min MPDU Start Spacing
796 */
65be27da
JS
797 max_AMPDU_len = pmlmeinfo->ht_cap.ampdu_params_info &
798 IEEE80211_HT_AMPDU_PARM_FACTOR;
5e93f352 799
c227ed0a 800 min_MPDU_spacing =
65be27da
JS
801 (pmlmeinfo->ht_cap.ampdu_params_info &
802 IEEE80211_HT_AMPDU_PARM_DENSITY) >> 2;
5e93f352 803
dce610a7
JS
804 rtl8723a_set_ampdu_min_space(padapter, min_MPDU_spacing);
805 rtl8723a_set_ampdu_factor(padapter, max_AMPDU_len);
5e93f352
LF
806}
807
7882ef45 808void ERP_IE_handler23a(struct rtw_adapter *padapter, const u8 *p)
5e93f352 809{
c227ed0a 810 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
811 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
812
b171da3c 813 if (p[1] > 1)
5e93f352
LF
814 return;
815
816 pmlmeinfo->ERP_enable = 1;
b171da3c 817 memcpy(&pmlmeinfo->ERP_IE, p + 2, p[1]);
5e93f352
LF
818}
819
820void VCS_update23a(struct rtw_adapter *padapter, struct sta_info *psta)
821{
c227ed0a
JS
822 struct registry_priv *pregpriv = &padapter->registrypriv;
823 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
824 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
825
826 switch (pregpriv->vrtl_carrier_sense) { /* 0:off 1:on 2:auto */
827 case 0: /* off */
828 psta->rtsen = 0;
829 psta->cts2self = 0;
830 break;
831 case 1: /* on */
0ceb7b15 832 if (pregpriv->vcs_type == RTS_CTS) {
5e93f352
LF
833 psta->rtsen = 1;
834 psta->cts2self = 0;
835 } else {
836 psta->rtsen = 0;
837 psta->cts2self = 1;
838 }
839 break;
840 case 2: /* auto */
841 default:
c227ed0a 842 if (pmlmeinfo->ERP_enable && pmlmeinfo->ERP_IE & BIT(1)) {
0ceb7b15 843 if (pregpriv->vcs_type == RTS_CTS) {
5e93f352
LF
844 psta->rtsen = 1;
845 psta->cts2self = 0;
846 } else {
847 psta->rtsen = 0;
848 psta->cts2self = 1;
849 }
850 } else {
851 psta->rtsen = 0;
852 psta->cts2self = 0;
853 }
854 break;
855 }
856}
857
c146551f 858int rtw_check_bcn_info23a(struct rtw_adapter *Adapter,
3ffa4355 859 struct ieee80211_mgmt *mgmt, u32 pkt_len)
5e93f352 860{
5e93f352 861 struct wlan_network *cur_network = &Adapter->mlmepriv.cur_network;
4dc5f8ba 862 struct ieee80211_ht_operation *pht_info;
c3761836 863 unsigned short val16;
bbf5fdbd 864 u8 crypto, bcn_channel;
c3761836 865 int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0, r;
68e6c796 866 int pie_len, ssid_len, privacy;
17b19396 867 const u8 *p, *ssid;
5e93f352 868
08551cbb 869 if (!is_client_associated_to_ap23a(Adapter))
17b19396 870 return _SUCCESS;
5e93f352 871
c146551f
JS
872 if (unlikely(!ieee80211_is_beacon(mgmt->frame_control))) {
873 printk(KERN_WARNING "%s: received a non beacon frame!\n",
874 __func__);
5e93f352
LF
875 return _FAIL;
876 }
877
0c45e617 878 if (!ether_addr_equal(cur_network->network.MacAddress, mgmt->bssid)) {
ea072786
JP
879 DBG_8723A("%s: linked but recv other bssid bcn %pM %pM\n",
880 __func__, mgmt->bssid,
881 cur_network->network.MacAddress);
5bd28bc2 882 return _FAIL;
17b19396 883 }
5e93f352
LF
884
885 /* check bw and channel offset */
886 /* parsing HT_CAP_IE */
17b19396 887 pie_len = pkt_len - offsetof(struct ieee80211_mgmt, u.beacon.variable);
3ffa4355 888
5e93f352 889 /* Checking for channel */
17b19396
JS
890 p = cfg80211_find_ie(WLAN_EID_DS_PARAMS, mgmt->u.beacon.variable,
891 pie_len);
3ffa4355
JS
892 if (p)
893 bcn_channel = p[2];
894 else {
895 /* In 5G, some ap do not have DSSET IE checking HT
896 info for channel */
17b19396
JS
897 p = cfg80211_find_ie(WLAN_EID_HT_OPERATION,
898 mgmt->u.beacon.variable, pie_len);
3ffa4355 899
ed08b4de
JS
900 if (p && p[1] > 0) {
901 pht_info = (struct ieee80211_ht_operation *)(p + 2);
4dc5f8ba 902 bcn_channel = pht_info->primary_chan;
ed08b4de 903 } else { /* we don't find channel IE, so don't check it */
3ffa4355
JS
904 DBG_8723A("Oops: %s we don't find channel IE, so don't "
905 "check it\n", __func__);
906 bcn_channel = Adapter->mlmeextpriv.cur_channel;
907 }
5e93f352
LF
908 }
909 if (bcn_channel != Adapter->mlmeextpriv.cur_channel) {
3ffa4355
JS
910 DBG_8723A("%s beacon channel:%d cur channel:%d disconnect\n",
911 __func__, bcn_channel,
912 Adapter->mlmeextpriv.cur_channel);
913 goto _mismatch;
5e93f352
LF
914 }
915
916 /* checking SSID */
17b19396 917 p = cfg80211_find_ie(WLAN_EID_SSID, mgmt->u.beacon.variable, pie_len);
82695d5c 918 if (p && p[1]) {
17b19396
JS
919 ssid = p + 2;
920 ssid_len = p[1];
82695d5c 921 } else {
3ffa4355
JS
922 DBG_8723A("%s marc: cannot find SSID for survey event\n",
923 __func__);
17b19396
JS
924 ssid = NULL;
925 ssid_len = 0;
5e93f352
LF
926 }
927
928 RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_,
929 ("%s bssid.Ssid.Ssid:%s bssid.Ssid.SsidLength:%d "
930 "cur_network->network.Ssid.Ssid:%s len:%d\n", __func__,
17b19396 931 ssid, ssid_len, cur_network->network.Ssid.ssid,
5e93f352
LF
932 cur_network->network.Ssid.ssid_len));
933
17b19396
JS
934 if (ssid_len != cur_network->network.Ssid.ssid_len || ssid_len > 32 ||
935 (ssid_len &&
936 memcmp(ssid, cur_network->network.Ssid.ssid, ssid_len))) {
937 DBG_8723A("%s(), SSID is not match return FAIL\n", __func__);
938 goto _mismatch;
5e93f352
LF
939 }
940
941 /* check encryption info */
17b19396 942 val16 = le16_to_cpu(mgmt->u.beacon.capab_info);
5e93f352 943
a665bcc2 944 if (val16 & WLAN_CAPABILITY_PRIVACY)
17b19396 945 privacy = 1;
5e93f352 946 else
17b19396 947 privacy = 0;
5e93f352
LF
948
949 RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_,
c3761836 950 ("%s(): cur_network->network.Privacy is %d, bssid.Privacy "
17b19396
JS
951 "is %d\n", __func__, cur_network->network.Privacy, privacy));
952 if (cur_network->network.Privacy != privacy) {
5e93f352
LF
953 DBG_8723A("%s(), privacy is not match return FAIL\n", __func__);
954 goto _mismatch;
955 }
956
17b19396 957 p = cfg80211_find_ie(WLAN_EID_RSN, mgmt->u.beacon.variable, pie_len);
77953edf 958 if (p && p[1]) {
bbf5fdbd
JS
959 crypto = ENCRYP_PROTOCOL_WPA2;
960 if (p && p[1]) {
961 r = rtw_parse_wpa2_ie23a(p, p[1] + 2, &group_cipher,
962 &pairwise_cipher, &is_8021x);
963 if (r == _SUCCESS)
964 RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_,
965 ("%s pnetwork->pairwise_cipher: %d, "
966 "pnetwork->group_cipher: %d, is_802x "
967 ": %d\n", __func__, pairwise_cipher,
968 group_cipher, is_8021x));
969 }
77953edf 970 } else {
f88ca604
JS
971 p = cfg80211_find_vendor_ie(WLAN_OUI_MICROSOFT,
972 WLAN_OUI_TYPE_MICROSOFT_WPA,
17b19396 973 mgmt->u.beacon.variable, pie_len);
bbf5fdbd
JS
974 if (p && p[1]) {
975 crypto = ENCRYP_PROTOCOL_WPA;
f88ca604 976 r = rtw_parse_wpa_ie23a(p, p[1] + 2, &group_cipher,
c3761836
JS
977 &pairwise_cipher, &is_8021x);
978 if (r == _SUCCESS)
5e93f352 979 RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_,
c3761836
JS
980 ("%s pnetwork->pairwise_cipher: %d, "
981 "group_cipher is %d, is_8021x is "
982 "%d\n", __func__, pairwise_cipher,
983 group_cipher, is_8021x));
5e93f352 984 } else {
bbf5fdbd
JS
985 if (privacy)
986 crypto = ENCRYP_PROTOCOL_WEP;
987 else
988 crypto = ENCRYP_PROTOCOL_OPENSYS;
5e93f352 989 }
bbf5fdbd
JS
990 }
991
992 if (cur_network->BcnInfo.encryp_protocol != crypto) {
993 DBG_8723A("%s(): encryption mismatch, return FAIL\n", __func__);
994 goto _mismatch;
995 }
5e93f352 996
bbf5fdbd 997 if (crypto == ENCRYP_PROTOCOL_WPA || crypto == ENCRYP_PROTOCOL_WPA2) {
5e93f352 998 RT_TRACE(_module_rtl871x_mlme_c_, _drv_err_,
c3761836
JS
999 ("%s cur_network->group_cipher is %d: %d\n", __func__,
1000 cur_network->BcnInfo.group_cipher, group_cipher));
1001 if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher ||
1002 group_cipher != cur_network->BcnInfo.group_cipher) {
1003 DBG_8723A("%s pairwise_cipher(%x:%x) or group_cipher "
1004 "(%x:%x) is not match, return FAIL\n",
1005 __func__, pairwise_cipher,
1006 cur_network->BcnInfo.pairwise_cipher,
1007 group_cipher,
1008 cur_network->BcnInfo.group_cipher);
5e93f352
LF
1009 goto _mismatch;
1010 }
1011
1012 if (is_8021x != cur_network->BcnInfo.is_8021x) {
c3761836
JS
1013 DBG_8723A("%s authentication is not match, return "
1014 "FAIL\n", __func__);
5e93f352
LF
1015 goto _mismatch;
1016 }
1017 }
1018
5e93f352
LF
1019 return _SUCCESS;
1020
1021_mismatch:
5e93f352
LF
1022
1023 return _FAIL;
1024}
1025
7882ef45
JS
1026void update_beacon23a_info(struct rtw_adapter *padapter,
1027 struct ieee80211_mgmt *mgmt,
b171da3c 1028 uint pkt_len, struct sta_info *psta)
5e93f352 1029{
5e93f352 1030 unsigned int len;
7882ef45 1031 const u8 *p;
5e93f352 1032
7882ef45 1033 len = pkt_len - offsetof(struct ieee80211_mgmt, u.beacon.variable);
5e93f352 1034
7882ef45
JS
1035 p = cfg80211_find_ie(WLAN_EID_HT_OPERATION, mgmt->u.beacon.variable,
1036 len);
1037 if (p)
1038 bwmode_update_check(padapter, p);
5e93f352 1039
7882ef45
JS
1040 p = cfg80211_find_ie(WLAN_EID_ERP_INFO, mgmt->u.beacon.variable, len);
1041 if (p) {
1042 ERP_IE_handler23a(padapter, p);
1043 VCS_update23a(padapter, psta);
5e93f352
LF
1044 }
1045}
1046
d5789247 1047bool is_ap_in_tkip23a(struct rtw_adapter *padapter)
5e93f352
LF
1048{
1049 u32 i;
5e93f352
LF
1050 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1051 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1052 struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
b171da3c 1053 const u8 *p;
5e93f352 1054
a94e12b1 1055 if (cur_network->capability & WLAN_CAPABILITY_PRIVACY) {
68e6c796 1056 for (i = 0; i < pmlmeinfo->network.IELength;) {
b171da3c 1057 p = pmlmeinfo->network.IEs + i;
5e93f352 1058
b171da3c 1059 switch (p[0]) {
9300c94b 1060 case WLAN_EID_VENDOR_SPECIFIC:
b171da3c
JS
1061 if (!memcmp(p + 2, RTW_WPA_OUI23A_TYPE, 4) &&
1062 !memcmp(p + 2 + 12, WPA_TKIP_CIPHER, 4))
5e93f352
LF
1063 return true;
1064 break;
25c934fa 1065 case WLAN_EID_RSN:
b171da3c 1066 if (!memcmp(p + 2 + 8, RSN_TKIP_CIPHER, 4))
5e93f352
LF
1067 return true;
1068 break;
1069 default:
1070 break;
1071 }
b171da3c 1072 i += (p[1] + 2);
5e93f352
LF
1073 }
1074 return false;
c227ed0a 1075 } else
5e93f352 1076 return false;
5e93f352
LF
1077}
1078
8e3d161a 1079bool should_forbid_n_rate23a(struct rtw_adapter *padapter)
5e93f352
LF
1080{
1081 u32 i;
c227ed0a 1082 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
5e93f352 1083 struct wlan_bssid_ex *cur_network = &pmlmepriv->cur_network.network;
b171da3c 1084 const u8 *p;
5e93f352 1085
a94e12b1 1086 if (cur_network->capability & WLAN_CAPABILITY_PRIVACY) {
68e6c796 1087 for (i = 0; i < cur_network->IELength;) {
b171da3c 1088 p = cur_network->IEs + i;
5e93f352 1089
b171da3c 1090 switch (p[0]) {
9300c94b 1091 case WLAN_EID_VENDOR_SPECIFIC:
b171da3c
JS
1092 if (!memcmp(p + 2, RTW_WPA_OUI23A_TYPE, 4) &&
1093 (!memcmp(p + 2 + 12,
c227ed0a 1094 WPA_CIPHER_SUITE_CCMP23A, 4) ||
b171da3c 1095 !memcmp(p + 2 + 16,
c227ed0a 1096 WPA_CIPHER_SUITE_CCMP23A, 4)))
5e93f352
LF
1097 return false;
1098 break;
25c934fa 1099 case WLAN_EID_RSN:
b171da3c 1100 if (!memcmp(p + 2 + 8,
c227ed0a 1101 RSN_CIPHER_SUITE_CCMP23A, 4) ||
b171da3c 1102 !memcmp(p + 2 + 12,
c227ed0a 1103 RSN_CIPHER_SUITE_CCMP23A, 4))
5e93f352
LF
1104 return false;
1105 default:
1106 break;
1107 }
1108
b171da3c 1109 i += (p[1] + 2);
5e93f352
LF
1110 }
1111 return true;
1112 } else {
1113 return false;
1114 }
1115}
1116
d5789247 1117bool is_ap_in_wep23a(struct rtw_adapter *padapter)
5e93f352
LF
1118{
1119 u32 i;
5e93f352
LF
1120 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1121 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1122 struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
b171da3c 1123 const u8 *p;
5e93f352 1124
a94e12b1 1125 if (cur_network->capability & WLAN_CAPABILITY_PRIVACY) {
68e6c796 1126 for (i = 0; i < pmlmeinfo->network.IELength;) {
b171da3c 1127 p = pmlmeinfo->network.IEs + i;
5e93f352 1128
b171da3c 1129 switch (p[0]) {
9300c94b 1130 case WLAN_EID_VENDOR_SPECIFIC:
b171da3c 1131 if (!memcmp(p + 2, RTW_WPA_OUI23A_TYPE, 4))
5e93f352
LF
1132 return false;
1133 break;
25c934fa 1134 case WLAN_EID_RSN:
5e93f352
LF
1135 return false;
1136
1137 default:
1138 break;
1139 }
1140
b171da3c 1141 i += (p[1] + 2);
5e93f352
LF
1142 }
1143
1144 return true;
c227ed0a 1145 } else
5e93f352 1146 return false;
5e93f352
LF
1147}
1148
c0b99bed 1149static int wifirate2_ratetbl_inx23a(unsigned char rate)
5e93f352 1150{
c227ed0a 1151 int inx = 0;
547f975e 1152
5e93f352
LF
1153 rate = rate & 0x7f;
1154
1155 switch (rate) {
1156 case 54*2:
1157 inx = 11;
1158 break;
1159 case 48*2:
1160 inx = 10;
1161 break;
1162 case 36*2:
1163 inx = 9;
1164 break;
1165 case 24*2:
1166 inx = 8;
1167 break;
1168 case 18*2:
1169 inx = 7;
1170 break;
1171 case 12*2:
1172 inx = 6;
1173 break;
1174 case 9*2:
1175 inx = 5;
1176 break;
1177 case 6*2:
1178 inx = 4;
1179 break;
1180 case 11*2:
1181 inx = 3;
1182 break;
1183 case 11:
1184 inx = 2;
1185 break;
1186 case 2*2:
1187 inx = 1;
1188 break;
1189 case 1*2:
1190 inx = 0;
1191 break;
1192 }
1193 return inx;
1194}
1195
1196unsigned int update_basic_rate23a(unsigned char *ptn, unsigned int ptn_sz)
1197{
1198 unsigned int i, num_of_rate;
1199 unsigned int mask = 0;
1200
1201 num_of_rate = (ptn_sz > NumRates)? NumRates: ptn_sz;
1202
1203 for (i = 0; i < num_of_rate; i++) {
1204 if ((*(ptn + i)) & 0x80)
1205 mask |= 0x1 << wifirate2_ratetbl_inx23a(*(ptn + i));
1206 }
1207 return mask;
1208}
1209
1210unsigned int update_supported_rate23a(unsigned char *ptn, unsigned int ptn_sz)
1211{
1212 unsigned int i, num_of_rate;
1213 unsigned int mask = 0;
1214
c227ed0a 1215 num_of_rate = (ptn_sz > NumRates) ? NumRates : ptn_sz;
5e93f352
LF
1216
1217 for (i = 0; i < num_of_rate; i++)
1218 mask |= 0x1 << wifirate2_ratetbl_inx23a(*(ptn + i));
1219 return mask;
1220}
1221
65be27da 1222unsigned int update_MSC_rate23a(struct ieee80211_ht_cap *pHT_caps)
5e93f352
LF
1223{
1224 unsigned int mask = 0;
1225
65be27da
JS
1226 mask = pHT_caps->mcs.rx_mask[0] << 12 |
1227 pHT_caps->mcs.rx_mask[1] << 20;
5e93f352
LF
1228
1229 return mask;
1230}
1231
1232int support_short_GI23a(struct rtw_adapter *padapter,
65be27da 1233 struct ieee80211_ht_cap *pHT_caps)
5e93f352 1234{
c227ed0a 1235 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
1236 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1237 unsigned char bit_offset;
1238
c227ed0a 1239 if (!pmlmeinfo->HT_enable)
5e93f352 1240 return _FAIL;
c227ed0a 1241 if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_RALINK)
5e93f352
LF
1242 return _FAIL;
1243 bit_offset = (pmlmeext->cur_bwmode & HT_CHANNEL_WIDTH_40)? 6: 5;
1244
65be27da 1245 if (pHT_caps->cap_info & cpu_to_le16(0x1 << bit_offset))
5e93f352
LF
1246 return _SUCCESS;
1247 else
1248 return _FAIL;
1249}
1250
1251unsigned char get_highest_rate_idx23a(u32 mask)
1252{
1253 int i;
1254 unsigned char rate_idx = 0;
1255
1256 for (i = 27; i >= 0; i--) {
1257 if (mask & BIT(i)) {
1258 rate_idx = i;
1259 break;
1260 }
1261 }
1262 return rate_idx;
1263}
1264
5e93f352
LF
1265void Update_RA_Entry23a(struct rtw_adapter *padapter, struct sta_info *psta)
1266{
1267 rtw_hal_update_ra_mask23a(psta, 0);
1268}
1269
c0b99bed
LF
1270static void enable_rate_adaptive(struct rtw_adapter *padapter,
1271 struct sta_info *psta)
5e93f352
LF
1272{
1273 Update_RA_Entry23a(padapter, psta);
1274}
1275
1276void set_sta_rate23a(struct rtw_adapter *padapter, struct sta_info *psta)
1277{
1278 /* rate adaptive */
1279 enable_rate_adaptive(padapter, psta);
1280}
1281
1282/* Update RRSR and Rate for USERATE */
1283void update_tx_basic_rate23a(struct rtw_adapter *padapter, u8 wirelessmode)
1284{
1285 unsigned char supported_rates[NDIS_802_11_LENGTH_RATES_EX];
5e93f352
LF
1286
1287 memset(supported_rates, 0, NDIS_802_11_LENGTH_RATES_EX);
1288
ff516e70 1289 if (wirelessmode == WIRELESS_11B) {
5e93f352
LF
1290 memcpy(supported_rates, rtw_basic_rate_cck, 4);
1291 } else if (wirelessmode & WIRELESS_11B) {
1292 memcpy(supported_rates, rtw_basic_rate_mix, 7);
1293 } else {
1294 memcpy(supported_rates, rtw_basic_rate_ofdm, 3);
1295 }
1296
1297 if (wirelessmode & WIRELESS_11B)
1298 update_mgnt_tx_rate23a(padapter, IEEE80211_CCK_RATE_1MB);
1299 else
1300 update_mgnt_tx_rate23a(padapter, IEEE80211_OFDM_RATE_6MB);
1301
fa2e5209 1302 HalSetBrateCfg23a(padapter, supported_rates);
5e93f352
LF
1303}
1304
1305unsigned char check_assoc_AP23a(u8 *pframe, uint len)
1306{
68e6c796 1307 int i;
c227ed0a
JS
1308 u8 epigram_vendor_flag;
1309 u8 ralink_vendor_flag;
b171da3c 1310 const u8 *p;
547f975e 1311
5e93f352
LF
1312 epigram_vendor_flag = 0;
1313 ralink_vendor_flag = 0;
1314
68e6c796 1315 for (i = 0; i < len;) {
b171da3c 1316 p = pframe + i;
5e93f352 1317
b171da3c 1318 switch (p[0]) {
9300c94b 1319 case WLAN_EID_VENDOR_SPECIFIC:
b171da3c
JS
1320 if (!memcmp(p + 2, ARTHEROS_OUI1, 3) ||
1321 !memcmp(p + 2, ARTHEROS_OUI2, 3)) {
5e93f352
LF
1322 DBG_8723A("link to Artheros AP\n");
1323 return HT_IOT_PEER_ATHEROS;
b171da3c 1324 } else if (!memcmp(p + 2, BROADCOM_OUI1, 3) ||
b171da3c 1325 !memcmp(p + 2, BROADCOM_OUI2, 3)) {
5e93f352
LF
1326 DBG_8723A("link to Broadcom AP\n");
1327 return HT_IOT_PEER_BROADCOM;
b171da3c 1328 } else if (!memcmp(p + 2, MARVELL_OUI, 3)) {
5e93f352
LF
1329 DBG_8723A("link to Marvell AP\n");
1330 return HT_IOT_PEER_MARVELL;
b171da3c 1331 } else if (!memcmp(p + 2, RALINK_OUI, 3)) {
c227ed0a 1332 if (!ralink_vendor_flag)
5e93f352 1333 ralink_vendor_flag = 1;
c227ed0a 1334 else {
5e93f352
LF
1335 DBG_8723A("link to Ralink AP\n");
1336 return HT_IOT_PEER_RALINK;
1337 }
b171da3c 1338 } else if (!memcmp(p + 2, CISCO_OUI, 3)) {
5e93f352
LF
1339 DBG_8723A("link to Cisco AP\n");
1340 return HT_IOT_PEER_CISCO;
b171da3c 1341 } else if (!memcmp(p + 2, REALTEK_OUI, 3)) {
5e93f352
LF
1342 DBG_8723A("link to Realtek 96B\n");
1343 return HT_IOT_PEER_REALTEK;
b171da3c 1344 } else if (!memcmp(p + 2, AIRGOCAP_OUI, 3)) {
5e93f352
LF
1345 DBG_8723A("link to Airgo Cap\n");
1346 return HT_IOT_PEER_AIRGO;
b171da3c 1347 } else if (!memcmp(p + 2, EPIGRAM_OUI, 3)) {
5e93f352
LF
1348 epigram_vendor_flag = 1;
1349 if (ralink_vendor_flag) {
1350 DBG_8723A("link to Tenda W311R AP\n");
1351 return HT_IOT_PEER_TENDA;
c227ed0a 1352 } else
5e93f352 1353 DBG_8723A("Capture EPIGRAM_OUI\n");
c227ed0a 1354 } else
5e93f352 1355 break;
5e93f352
LF
1356 default:
1357 break;
1358 }
1359
b171da3c 1360 i += (p[1] + 2);
5e93f352
LF
1361 }
1362
1363 if (ralink_vendor_flag && !epigram_vendor_flag) {
1364 DBG_8723A("link to Ralink AP\n");
1365 return HT_IOT_PEER_RALINK;
1366 } else if (ralink_vendor_flag && epigram_vendor_flag) {
1367 DBG_8723A("link to Tenda W311R AP\n");
1368 return HT_IOT_PEER_TENDA;
1369 } else {
1370 DBG_8723A("link to new AP\n");
1371 return HT_IOT_PEER_UNKNOWN;
1372 }
1373}
1374
1375void update_IOT_info23a(struct rtw_adapter *padapter)
1376{
c227ed0a 1377 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
1378 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1379
1380 switch (pmlmeinfo->assoc_AP_vendor) {
1381 case HT_IOT_PEER_MARVELL:
1382 pmlmeinfo->turboMode_cts2self = 1;
1383 pmlmeinfo->turboMode_rtsen = 0;
1384 break;
1385 case HT_IOT_PEER_RALINK:
1386 pmlmeinfo->turboMode_cts2self = 0;
1387 pmlmeinfo->turboMode_rtsen = 1;
1388 /* disable high power */
585eefb4
JS
1389 rtl8723a_odm_support_ability_clr(padapter, (u32)
1390 ~DYNAMIC_BB_DYNAMIC_TXPWR);
5e93f352
LF
1391 break;
1392 case HT_IOT_PEER_REALTEK:
1393 /* rtw_write16(padapter, 0x4cc, 0xffff); */
1394 /* rtw_write16(padapter, 0x546, 0x01c0); */
1395 /* disable high power */
585eefb4
JS
1396 rtl8723a_odm_support_ability_clr(padapter, (u32)
1397 ~DYNAMIC_BB_DYNAMIC_TXPWR);
5e93f352
LF
1398 break;
1399 default:
1400 pmlmeinfo->turboMode_cts2self = 0;
1401 pmlmeinfo->turboMode_rtsen = 1;
1402 break;
1403 }
1404}
1405
1406void update_capinfo23a(struct rtw_adapter *Adapter, u16 updateCap)
1407{
c227ed0a 1408 struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv;
5e93f352 1409 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
5e93f352
LF
1410
1411 if (updateCap & cShortPreamble) {
1412 /* Short Preamble */
1413 if (pmlmeinfo->preamble_mode != PREAMBLE_SHORT) {
1414 /* PREAMBLE_LONG or PREAMBLE_AUTO */
5e93f352 1415 pmlmeinfo->preamble_mode = PREAMBLE_SHORT;
093dd41e 1416 rtl8723a_ack_preamble(Adapter, true);
5e93f352
LF
1417 }
1418 } else { /* Long Preamble */
1419 if (pmlmeinfo->preamble_mode != PREAMBLE_LONG) {
1420 /* PREAMBLE_SHORT or PREAMBLE_AUTO */
5e93f352 1421 pmlmeinfo->preamble_mode = PREAMBLE_LONG;
093dd41e 1422 rtl8723a_ack_preamble(Adapter, false);
5e93f352
LF
1423 }
1424 }
1425 if (updateCap & cIBSS) {
1426 /* Filen: See 802.11-2007 p.91 */
1427 pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
1428 } else {
1429 /* Filen: See 802.11-2007 p.90 */
c227ed0a
JS
1430 if (pmlmeext->cur_wireless_mode &
1431 (WIRELESS_11G | WIRELESS_11_24N)) {
5e93f352
LF
1432 if (updateCap & cShortSlotTime) { /* Short Slot Time */
1433 if (pmlmeinfo->slotTime != SHORT_SLOT_TIME)
1434 pmlmeinfo->slotTime = SHORT_SLOT_TIME;
1435 } else { /* Long Slot Time */
1436 if (pmlmeinfo->slotTime != NON_SHORT_SLOT_TIME)
c227ed0a
JS
1437 pmlmeinfo->slotTime =
1438 NON_SHORT_SLOT_TIME;
5e93f352 1439 }
c227ed0a
JS
1440 } else if (pmlmeext->cur_wireless_mode &
1441 (WIRELESS_11A | WIRELESS_11_5N)) {
5e93f352
LF
1442 pmlmeinfo->slotTime = SHORT_SLOT_TIME;
1443 } else {
1444 /* B Mode */
1445 pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
1446 }
1447 }
04c38427 1448 rtl8723a_set_slot_time(Adapter, pmlmeinfo->slotTime);
5e93f352
LF
1449}
1450
1451void update_wireless_mode23a(struct rtw_adapter *padapter)
1452{
1453 int ratelen, network_type = 0;
c227ed0a 1454 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
1455 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1456 struct wlan_bssid_ex *cur_network = &pmlmeinfo->network;
c227ed0a 1457 unsigned char *rate = cur_network->SupportedRates;
5e93f352
LF
1458
1459 ratelen = rtw_get_rateset_len23a(cur_network->SupportedRates);
1460
1461 if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable))
1462 pmlmeinfo->HT_enable = 1;
1463
1464 if (pmlmeext->cur_channel > 14) {
1465 if (pmlmeinfo->HT_enable)
1466 network_type = WIRELESS_11_5N;
1467 network_type |= WIRELESS_11A;
1468 } else {
1469 if (pmlmeinfo->HT_enable)
1470 network_type = WIRELESS_11_24N;
1471
c227ed0a 1472 if (cckratesonly_included23a(rate, ratelen) == true)
5e93f352 1473 network_type |= WIRELESS_11B;
c227ed0a 1474 else if (cckrates_included23a(rate, ratelen) == true)
5e93f352
LF
1475 network_type |= WIRELESS_11BG;
1476 else
1477 network_type |= WIRELESS_11G;
1478 }
1479
c227ed0a
JS
1480 pmlmeext->cur_wireless_mode =
1481 network_type & padapter->registrypriv.wireless_mode;
5e93f352 1482
7b7aefaa
JS
1483 /* 0x0808 -> for CCK, 0x0a0a -> for OFDM */
1484 /* change this value if having IOT issues. */
1485 rtl8723a_set_resp_sifs(padapter, 0x08, 0x08, 0x0a, 0x0a);
5e93f352
LF
1486
1487 if (pmlmeext->cur_wireless_mode & WIRELESS_11B)
1488 update_mgnt_tx_rate23a(padapter, IEEE80211_CCK_RATE_1MB);
1489 else
1490 update_mgnt_tx_rate23a(padapter, IEEE80211_OFDM_RATE_6MB);
1491}
1492
1493void update_bmc_sta_support_rate23a(struct rtw_adapter *padapter, u32 mac_id)
1494{
1495 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1496 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1497
1498 if (pmlmeext->cur_wireless_mode & WIRELESS_11B) {
1499 /* Only B, B/G, and B/G/N AP could use CCK rate */
5bd28bc2
JS
1500 memcpy((pmlmeinfo->FW_sta_info[mac_id].SupportedRates),
1501 rtw_basic_rate_cck, 4);
5e93f352 1502 } else {
c227ed0a 1503 memcpy(pmlmeinfo->FW_sta_info[mac_id].SupportedRates,
5bd28bc2 1504 rtw_basic_rate_ofdm, 3);
5e93f352
LF
1505 }
1506}
1507
bf350274
JS
1508int update_sta_support_rate23a(struct rtw_adapter *padapter, u8 *pvar_ie,
1509 uint var_ie_len, int cam_idx)
5e93f352 1510{
bf350274 1511 int supportRateNum = 0;
5e93f352
LF
1512 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1513 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
bf350274 1514 const u8 *p;
5e93f352 1515
bf350274
JS
1516 p = cfg80211_find_ie(WLAN_EID_SUPP_RATES, pvar_ie, var_ie_len);
1517 if (!p)
5e93f352
LF
1518 return _FAIL;
1519
bf350274
JS
1520 memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates, p + 2, p[1]);
1521 supportRateNum = p[1];
5e93f352 1522
bf350274
JS
1523 p = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, pvar_ie, var_ie_len);
1524 if (p)
1525 memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates +
1526 supportRateNum, p + 2, p[1]);
5e93f352
LF
1527 return _SUCCESS;
1528}
1529
c227ed0a
JS
1530void process_addba_req23a(struct rtw_adapter *padapter,
1531 u8 *paddba_req, u8 *addr)
5e93f352
LF
1532{
1533 struct sta_info *psta;
1534 u16 tid, start_seq, param;
1535 struct recv_reorder_ctrl *preorder_ctrl;
1536 struct sta_priv *pstapriv = &padapter->stapriv;
7e6646d5 1537 struct ADDBA_request *preq = (struct ADDBA_request *)paddba_req;
c227ed0a 1538 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
5e93f352
LF
1539 struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info;
1540
1541 psta = rtw_get_stainfo23a(pstapriv, addr);
1542
1543 if (psta) {
1544 start_seq = le16_to_cpu(preq->BA_starting_seqctrl) >> 4;
1545
1546 param = le16_to_cpu(preq->BA_para_set);
c227ed0a 1547 tid = (param >> 2) & 0x0f;
5e93f352
LF
1548
1549 preorder_ctrl = &psta->recvreorder_ctrl[tid];
1550
1551 preorder_ctrl->indicate_seq = 0xffff;
1552
c227ed0a
JS
1553 preorder_ctrl->enable = (pmlmeinfo->bAcceptAddbaReq == true) ?
1554 true : false;
5e93f352
LF
1555 }
1556}