1 /******************************************************************************
3 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
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.
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
14 ******************************************************************************/
15 #define _RTW_WLAN_UTIL_C_
17 #include <osdep_service.h>
18 #include <drv_types.h>
19 #include <linux/ieee80211.h>
21 #include <rtl8723a_spec.h>
23 static unsigned char ARTHEROS_OUI1
[] = {0x00, 0x03, 0x7f};
24 static unsigned char ARTHEROS_OUI2
[] = {0x00, 0x13, 0x74};
26 static unsigned char BROADCOM_OUI1
[] = {0x00, 0x10, 0x18};
27 static unsigned char BROADCOM_OUI2
[] = {0x00, 0x0a, 0xf7};
29 static unsigned char CISCO_OUI
[] = {0x00, 0x40, 0x96};
30 static unsigned char MARVELL_OUI
[] = {0x00, 0x50, 0x43};
31 static unsigned char RALINK_OUI
[] = {0x00, 0x0c, 0x43};
32 static unsigned char REALTEK_OUI
[] = {0x00, 0xe0, 0x4c};
33 static unsigned char AIRGOCAP_OUI
[] = {0x00, 0x0a, 0xf5};
34 static unsigned char EPIGRAM_OUI
[] = {0x00, 0x90, 0x4c};
36 static unsigned char WPA_TKIP_CIPHER
[4] = {0x00, 0x50, 0xf2, 0x02};
37 static unsigned char RSN_TKIP_CIPHER
[4] = {0x00, 0x0f, 0xac, 0x02};
39 #define R2T_PHY_DELAY 0
41 /* define WAIT_FOR_BCN_TO_MIN 3000 */
42 #define WAIT_FOR_BCN_TO_MIN 6000
43 #define WAIT_FOR_BCN_TO_MAX 20000
45 static u8 rtw_basic_rate_cck
[4] = {
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
52 static u8 rtw_basic_rate_ofdm
[3] = {
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
58 static u8 rtw_basic_rate_mix
[7] = {
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
68 int cckrates_included23a(unsigned char *rate
, int ratelen
)
72 for (i
= 0; i
< ratelen
; i
++) {
73 if (((rate
[i
]) & 0x7f) == 2 || ((rate
[i
]) & 0x7f) == 4 ||
74 ((rate
[i
]) & 0x7f) == 11 || ((rate
[i
]) & 0x7f) == 22)
81 int cckratesonly_included23a(unsigned char *rate
, int ratelen
)
85 for (i
= 0; i
< ratelen
; i
++) {
86 if (((rate
[i
]) & 0x7f) != 2 && ((rate
[i
]) & 0x7f) != 4 &&
87 ((rate
[i
]) & 0x7f) != 11 && ((rate
[i
]) & 0x7f) != 22)
94 unsigned char networktype_to_raid23a(unsigned char network_type
)
98 switch (network_type
) {
100 raid
= RATR_INX_WIRELESS_B
;
104 raid
= RATR_INX_WIRELESS_G
;
107 raid
= RATR_INX_WIRELESS_GB
;
109 case WIRELESS_11_24N
:
111 raid
= RATR_INX_WIRELESS_N
;
113 case WIRELESS_11A_5N
:
114 case WIRELESS_11G_24N
:
115 raid
= RATR_INX_WIRELESS_NG
;
117 case WIRELESS_11BG_24N
:
118 raid
= RATR_INX_WIRELESS_NGB
;
121 raid
= RATR_INX_WIRELESS_GB
;
127 u8
judge_network_type23a(struct rtw_adapter
*padapter
,
128 unsigned char *rate
, int ratelen
)
131 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
132 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
134 if (pmlmeext
->cur_channel
> 14) {
135 if (pmlmeinfo
->HT_enable
)
136 network_type
= WIRELESS_11_5N
;
137 network_type
|= WIRELESS_11A
;
139 if (pmlmeinfo
->HT_enable
)
140 network_type
= WIRELESS_11_24N
;
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
;
147 network_type
|= WIRELESS_11G
;
152 static unsigned char ratetbl_val_2wifirate(unsigned char rate
)
154 unsigned char val
= 0;
156 switch (rate
& 0x7f) {
158 val
= IEEE80211_CCK_RATE_1MB
;
161 val
= IEEE80211_CCK_RATE_2MB
;
164 val
= IEEE80211_CCK_RATE_5MB
;
167 val
= IEEE80211_CCK_RATE_11MB
;
170 val
= IEEE80211_OFDM_RATE_6MB
;
173 val
= IEEE80211_OFDM_RATE_9MB
;
176 val
= IEEE80211_OFDM_RATE_12MB
;
179 val
= IEEE80211_OFDM_RATE_18MB
;
182 val
= IEEE80211_OFDM_RATE_24MB
;
185 val
= IEEE80211_OFDM_RATE_36MB
;
188 val
= IEEE80211_OFDM_RATE_48MB
;
191 val
= IEEE80211_OFDM_RATE_54MB
;
197 static int is_basicrate(struct rtw_adapter
*padapter
, unsigned char rate
)
201 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
203 for (i
= 0; i
< NumRates
; i
++) {
204 val
= pmlmeext
->basicrate
[i
];
206 if (val
!= 0xff && val
!= 0xfe) {
207 if (rate
== ratetbl_val_2wifirate(val
))
215 static unsigned int ratetbl2rateset(struct rtw_adapter
*padapter
,
216 unsigned char *rateset
)
220 unsigned int len
= 0;
221 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
223 for (i
= 0; i
< NumRates
; i
++) {
224 rate
= pmlmeext
->datarate
[i
];
232 rate
= ratetbl_val_2wifirate(rate
);
234 if (is_basicrate(padapter
, rate
) == true)
235 rate
|= IEEE80211_BASIC_RATE_MASK
;
245 void get_rate_set23a(struct rtw_adapter
*padapter
,
246 unsigned char *pbssrate
, int *bssrate_len
)
248 unsigned char supportedrates
[NumRates
];
250 memset(supportedrates
, 0, NumRates
);
251 *bssrate_len
= ratetbl2rateset(padapter
, supportedrates
);
252 memcpy(pbssrate
, supportedrates
, *bssrate_len
);
255 void UpdateBrateTbl23a(struct rtw_adapter
*Adapter
, u8
*mBratesOS
)
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;
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
;
279 void Update23aTblForSoftAP(u8
*bssrateset
, u32 bssratelen
)
284 for (i
= 0; i
< bssratelen
; i
++) {
285 rate
= bssrateset
[i
] & 0x7f;
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
;
297 inline u8
rtw_get_oper_ch23a(struct rtw_adapter
*adapter
)
299 return adapter_to_dvobj(adapter
)->oper_channel
;
302 inline void rtw_set_oper_ch23a(struct rtw_adapter
*adapter
, u8 ch
)
304 adapter_to_dvobj(adapter
)->oper_channel
= ch
;
307 inline u8
rtw_get_oper_bw23a(struct rtw_adapter
*adapter
)
309 return adapter_to_dvobj(adapter
)->oper_bwmode
;
312 inline void rtw_set_oper_bw23a(struct rtw_adapter
*adapter
, u8 bw
)
314 adapter_to_dvobj(adapter
)->oper_bwmode
= bw
;
317 inline u8
rtw_get_oper_ch23aoffset(struct rtw_adapter
*adapter
)
319 return adapter_to_dvobj(adapter
)->oper_ch_offset
;
322 inline void rtw_set_oper_ch23aoffset23a(struct rtw_adapter
*adapter
, u8 offset
)
324 adapter_to_dvobj(adapter
)->oper_ch_offset
= offset
;
327 void SelectChannel23a(struct rtw_adapter
*padapter
, unsigned char channel
)
329 mutex_lock(&adapter_to_dvobj(padapter
)->setch_mutex
);
331 /* saved channel info */
332 rtw_set_oper_ch23a(padapter
, channel
);
334 PHY_SwChnl8723A(padapter
, channel
);
336 mutex_unlock(&adapter_to_dvobj(padapter
)->setch_mutex
);
339 static void set_bwmode(struct rtw_adapter
*padapter
, unsigned short bwmode
,
340 unsigned char channel_offset
)
342 mutex_lock(&adapter_to_dvobj(padapter
)->setbw_mutex
);
345 rtw_set_oper_bw23a(padapter
, bwmode
);
346 rtw_set_oper_ch23aoffset23a(padapter
, channel_offset
);
348 PHY_SetBWMode23a8723A(padapter
, (enum ht_channel_width
)bwmode
,
351 mutex_unlock(&adapter_to_dvobj(padapter
)->setbw_mutex
);
354 void set_channel_bwmode23a(struct rtw_adapter
*padapter
, unsigned char channel
,
355 unsigned char channel_offset
, unsigned short bwmode
)
359 if (bwmode
== HT_CHANNEL_WIDTH_20
||
360 channel_offset
== HAL_PRIME_CHNL_OFFSET_DONT_CARE
) {
361 /* SelectChannel23a(padapter, channel); */
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;
369 /* SelectChannel23a(padapter, channel - 2); */
370 center_ch
= channel
- 2;
375 mutex_lock(&adapter_to_dvobj(padapter
)->setch_mutex
);
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
);
382 PHY_SwChnl8723A(padapter
, center_ch
); /* set center channel */
384 mutex_unlock(&adapter_to_dvobj(padapter
)->setch_mutex
);
386 set_bwmode(padapter
, bwmode
, channel_offset
);
389 inline u8
*get_my_bssid23a(struct wlan_bssid_ex
*pnetwork
)
391 return pnetwork
->MacAddress
;
394 bool is_client_associated_to_ap23a(struct rtw_adapter
*padapter
)
396 struct mlme_ext_priv
*pmlmeext
;
397 struct mlme_ext_info
*pmlmeinfo
;
402 pmlmeext
= &padapter
->mlmeextpriv
;
403 pmlmeinfo
= &pmlmeext
->mlmext_info
;
405 if (pmlmeinfo
->state
& WIFI_FW_ASSOC_SUCCESS
&&
406 (pmlmeinfo
->state
& 0x03) == MSR_INFRA
)
412 bool is_client_associated_to_ibss23a(struct rtw_adapter
*padapter
)
414 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
415 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
417 if (pmlmeinfo
->state
& WIFI_FW_ASSOC_SUCCESS
&&
418 (pmlmeinfo
->state
& 0x03) == MSR_ADHOC
)
424 bool is_IBSS_empty23a(struct rtw_adapter
*padapter
)
427 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
428 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
430 for (i
= IBSS_START_MAC_ID
; i
< NUM_STA
; i
++) {
431 if (pmlmeinfo
->FW_sta_info
[i
].status
== 1)
438 unsigned int decide_wait_for_beacon_timeout23a(unsigned int bcn_interval
)
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
;
445 return bcn_interval
<< 2;
448 void clear_cam_entry23a(struct rtw_adapter
*padapter
, u8 entry
)
450 unsigned char null_sta
[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
452 unsigned char null_key
[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
453 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
454 0x00, 0x00, 0x00, 0x00};
456 rtl8723a_cam_write(padapter
, entry
, 0, null_sta
, null_key
);
459 int allocate_fw_sta_entry23a(struct rtw_adapter
*padapter
)
462 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
463 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
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;
476 void flush_all_cam_entry23a(struct rtw_adapter
*padapter
)
478 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
479 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
481 rtl8723a_cam_invalidate_all(padapter
);
483 memset(pmlmeinfo
->FW_sta_info
, 0, sizeof(pmlmeinfo
->FW_sta_info
));
486 int WMM_param_handler23a(struct rtw_adapter
*padapter
, const u8
*p
)
488 /* struct registry_priv *pregpriv = &padapter->registrypriv; */
489 struct mlme_priv
*pmlmepriv
= &padapter
->mlmepriv
;
490 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
491 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
493 if (pmlmepriv
->qos_option
== 0) {
494 pmlmeinfo
->WMM_enable
= 0;
498 pmlmeinfo
->WMM_enable
= 1;
499 memcpy(&pmlmeinfo
->WMM_param
, p
+ 2 + 6,
500 sizeof(struct WMM_para_element
));
504 void WMMOnAssocRsp23a(struct rtw_adapter
*padapter
)
506 u8 ACI
, ACM
, AIFS
, ECWMin
, ECWMax
, aSifsTime
;
511 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
512 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
513 struct xmit_priv
*pxmitpriv
= &padapter
->xmitpriv
;
514 struct registry_priv
*pregpriv
= &padapter
->registrypriv
;
516 if (pmlmeinfo
->WMM_enable
== 0) {
517 padapter
->mlmepriv
.acm_mask
= 0;
523 if (pmlmeext
->cur_wireless_mode
== WIRELESS_11B
)
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;
532 /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */
533 AIFS
= (pmlmeinfo
->WMM_param
.ac_param
[i
].ACI_AIFSN
& 0x0f) *
534 pmlmeinfo
->slotTime
+ aSifsTime
;
536 ECWMin
= pmlmeinfo
->WMM_param
.ac_param
[i
].CW
& 0x0f;
537 ECWMax
= (pmlmeinfo
->WMM_param
.ac_param
[i
].CW
& 0xf0) >> 4;
538 TXOP
= le16_to_cpu(pmlmeinfo
->WMM_param
.ac_param
[i
].TXOP_limit
);
540 acParm
= AIFS
| (ECWMin
<< 8) | (ECWMax
<< 12) | (TXOP
<< 16);
544 rtl8723a_set_ac_param_be(padapter
, acParm
);
545 acm_mask
|= (ACM
? BIT(1):0);
546 edca
[XMIT_BE_QUEUE
] = acParm
;
549 rtl8723a_set_ac_param_bk(padapter
, acParm
);
550 /* acm_mask |= (ACM? BIT(0):0); */
551 edca
[XMIT_BK_QUEUE
] = acParm
;
554 rtl8723a_set_ac_param_vi(padapter
, acParm
);
555 acm_mask
|= (ACM
? BIT(2):0);
556 edca
[XMIT_VI_QUEUE
] = acParm
;
559 rtl8723a_set_ac_param_vo(padapter
, acParm
);
560 acm_mask
|= (ACM
? BIT(3):0);
561 edca
[XMIT_VO_QUEUE
] = acParm
;
565 DBG_8723A("WMM(%x): %x, %x\n", ACI
, ACM
, acParm
);
568 if (padapter
->registrypriv
.acm_method
== 1)
569 rtl8723a_set_acm_ctrl(padapter
, acm_mask
);
571 padapter
->mlmepriv
.acm_mask
= acm_mask
;
573 inx
[0] = 0; inx
[1] = 1; inx
[2] = 2; inx
[3] = 3;
575 if (pregpriv
->wifi_spec
== 1) {
576 u32 j
, tmp
, change_inx
= false;
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)) {
584 } else if ((edca
[j
] & 0xFFFF) ==
585 (edca
[i
] & 0xFFFF)) {
587 if ((edca
[j
] >> 16) > (edca
[i
] >> 16))
606 for (i
= 0; i
<4; i
++) {
607 pxmitpriv
->wmm_para_seq
[i
] = inx
[i
];
608 DBG_8723A("wmm_para_seq(%d): %d\n", i
,
609 pxmitpriv
->wmm_para_seq
[i
]);
613 static void bwmode_update_check(struct rtw_adapter
*padapter
, const u8
*p
)
615 struct ieee80211_ht_operation
*pHT_info
;
616 struct mlme_priv
*pmlmepriv
= &padapter
->mlmepriv
;
617 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
618 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
619 struct registry_priv
*pregistrypriv
= &padapter
->registrypriv
;
620 struct ht_priv
*phtpriv
= &pmlmepriv
->htpriv
;
621 unsigned char new_bwmode
;
622 unsigned char new_ch_offset
;
626 if (!phtpriv
->ht_option
)
628 if (p
[1] != sizeof(struct ieee80211_ht_operation
))
631 pHT_info
= (struct ieee80211_ht_operation
*)(p
+ 2);
633 if ((pHT_info
->ht_param
& IEEE80211_HT_PARAM_CHAN_WIDTH_ANY
) &&
634 pregistrypriv
->cbw40_enable
) {
635 new_bwmode
= HT_CHANNEL_WIDTH_40
;
637 switch (pHT_info
->ht_param
& IEEE80211_HT_PARAM_CHA_SEC_OFFSET
){
638 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE
:
639 new_ch_offset
= HAL_PRIME_CHNL_OFFSET_LOWER
;
641 case IEEE80211_HT_PARAM_CHA_SEC_BELOW
:
642 new_ch_offset
= HAL_PRIME_CHNL_OFFSET_UPPER
;
645 new_ch_offset
= HAL_PRIME_CHNL_OFFSET_DONT_CARE
;
649 new_bwmode
= HT_CHANNEL_WIDTH_20
;
650 new_ch_offset
= HAL_PRIME_CHNL_OFFSET_DONT_CARE
;
653 if (new_bwmode
!= pmlmeext
->cur_bwmode
||
654 new_ch_offset
!= pmlmeext
->cur_ch_offset
) {
655 pmlmeinfo
->bwmode_updated
= true;
657 pmlmeext
->cur_bwmode
= new_bwmode
;
658 pmlmeext
->cur_ch_offset
= new_ch_offset
;
660 /* update HT info also */
661 HT_info_handler23a(padapter
, p
);
663 pmlmeinfo
->bwmode_updated
= false;
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
;
670 /* set_channel_bwmode23a(padapter, pmlmeext->cur_channel,
671 pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
673 /* update ap's stainfo */
674 psta
= rtw_get_stainfo23a(pstapriv
, cur_network
->MacAddress
);
676 struct ht_priv
*phtpriv_sta
= &psta
->htpriv
;
678 if (phtpriv_sta
->ht_option
) {
680 phtpriv_sta
->bwmode
= pmlmeext
->cur_bwmode
;
681 phtpriv_sta
->ch_offset
=
682 pmlmeext
->cur_ch_offset
;
684 phtpriv_sta
->bwmode
= HT_CHANNEL_WIDTH_20
;
685 phtpriv_sta
->ch_offset
=
686 HAL_PRIME_CHNL_OFFSET_DONT_CARE
;
692 void HT_caps_handler23a(struct rtw_adapter
*padapter
, const u8
*p
)
696 u8 max_AMPDU_len
, min_MPDU_spacing
;
697 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
698 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
699 struct mlme_priv
*pmlmepriv
= &padapter
->mlmepriv
;
700 struct ht_priv
*phtpriv
= &pmlmepriv
->htpriv
;
701 struct ieee80211_ht_cap
*cap
;
707 if (!phtpriv
->ht_option
)
710 pmlmeinfo
->HT_caps_enable
= 1;
712 cap
= &pmlmeinfo
->ht_cap
;
714 for (i
= 0; i
< p
[1]; i
++) {
716 dstcap
[i
] &= p
[i
+ 2];
718 /* modify from fw by Thomas 2010/11/17 */
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
;
725 max_AMPDU_len
= cap
->ampdu_params_info
&
726 IEEE80211_HT_AMPDU_PARM_FACTOR
;
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
;
734 min_MPDU_spacing
= p
[i
+ 2] &
735 IEEE80211_HT_AMPDU_PARM_DENSITY
;
737 cap
->ampdu_params_info
=
738 max_AMPDU_len
| min_MPDU_spacing
;
742 rf_type
= rtl8723a_get_rf_type(padapter
);
744 /* update the MCS rates */
745 for (i
= 0; i
< IEEE80211_HT_MCS_MASK_LEN
; i
++) {
746 if (rf_type
== RF_1T1R
|| rf_type
== RF_1T2R
)
747 cap
->mcs
.rx_mask
[i
] &= MCS_rate_1R23A
[i
];
749 cap
->mcs
.rx_mask
[i
] &= MCS_rate_2R23A
[i
];
753 void HT_info_handler23a(struct rtw_adapter
*padapter
, const u8
*p
)
755 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
756 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
757 struct mlme_priv
*pmlmepriv
= &padapter
->mlmepriv
;
758 struct ht_priv
*phtpriv
= &pmlmepriv
->htpriv
;
763 if (!phtpriv
->ht_option
)
766 if (p
[1] != sizeof(struct ieee80211_ht_operation
))
769 pmlmeinfo
->HT_info_enable
= 1;
770 memcpy(&pmlmeinfo
->HT_info
, p
+ 2, p
[1]);
773 void HTOnAssocRsp23a(struct rtw_adapter
*padapter
)
775 unsigned char max_AMPDU_len
;
776 unsigned char min_MPDU_spacing
;
777 /* struct registry_priv *pregpriv = &padapter->registrypriv; */
778 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
779 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
781 DBG_8723A("%s\n", __func__
);
783 if (pmlmeinfo
->HT_info_enable
&& pmlmeinfo
->HT_caps_enable
)
784 pmlmeinfo
->HT_enable
= 1;
786 pmlmeinfo
->HT_enable
= 0;
787 /* set_channel_bwmode23a(padapter, pmlmeext->cur_channel,
788 pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
792 /* handle A-MPDU parameter field */
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
797 max_AMPDU_len
= pmlmeinfo
->ht_cap
.ampdu_params_info
&
798 IEEE80211_HT_AMPDU_PARM_FACTOR
;
801 (pmlmeinfo
->ht_cap
.ampdu_params_info
&
802 IEEE80211_HT_AMPDU_PARM_DENSITY
) >> 2;
804 rtl8723a_set_ampdu_min_space(padapter
, min_MPDU_spacing
);
805 rtl8723a_set_ampdu_factor(padapter
, max_AMPDU_len
);
808 void ERP_IE_handler23a(struct rtw_adapter
*padapter
, const u8
*p
)
810 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
811 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
816 pmlmeinfo
->ERP_enable
= 1;
817 memcpy(&pmlmeinfo
->ERP_IE
, p
+ 2, p
[1]);
820 void VCS_update23a(struct rtw_adapter
*padapter
, struct sta_info
*psta
)
822 struct registry_priv
*pregpriv
= &padapter
->registrypriv
;
823 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
824 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
826 switch (pregpriv
->vrtl_carrier_sense
) { /* 0:off 1:on 2:auto */
832 if (pregpriv
->vcs_type
== RTS_CTS
) {
842 if (pmlmeinfo
->ERP_enable
&& pmlmeinfo
->ERP_IE
& BIT(1)) {
843 if (pregpriv
->vcs_type
== RTS_CTS
) {
858 int rtw_check_bcn_info23a(struct rtw_adapter
*Adapter
,
859 struct ieee80211_mgmt
*mgmt
, u32 pkt_len
)
861 struct wlan_network
*cur_network
= &Adapter
->mlmepriv
.cur_network
;
862 struct ieee80211_ht_operation
*pht_info
;
863 unsigned short val16
;
864 u8 crypto
, bcn_channel
;
865 int group_cipher
= 0, pairwise_cipher
= 0, is_8021x
= 0, r
;
866 int pie_len
, ssid_len
, privacy
;
869 if (!is_client_associated_to_ap23a(Adapter
))
872 if (unlikely(!ieee80211_is_beacon(mgmt
->frame_control
))) {
873 printk(KERN_WARNING
"%s: received a non beacon frame!\n",
878 if (!ether_addr_equal(cur_network
->network
.MacAddress
, mgmt
->bssid
)) {
879 DBG_8723A("%s: linked but recv other bssid bcn %pM %pM\n",
880 __func__
, mgmt
->bssid
,
881 cur_network
->network
.MacAddress
);
885 /* check bw and channel offset */
886 /* parsing HT_CAP_IE */
887 pie_len
= pkt_len
- offsetof(struct ieee80211_mgmt
, u
.beacon
.variable
);
889 /* Checking for channel */
890 p
= cfg80211_find_ie(WLAN_EID_DS_PARAMS
, mgmt
->u
.beacon
.variable
,
895 /* In 5G, some ap do not have DSSET IE checking HT
897 p
= cfg80211_find_ie(WLAN_EID_HT_OPERATION
,
898 mgmt
->u
.beacon
.variable
, pie_len
);
901 pht_info
= (struct ieee80211_ht_operation
*)(p
+ 2);
902 bcn_channel
= pht_info
->primary_chan
;
903 } else { /* we don't find channel IE, so don't check it */
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
;
909 if (bcn_channel
!= Adapter
->mlmeextpriv
.cur_channel
) {
910 DBG_8723A("%s beacon channel:%d cur channel:%d disconnect\n",
911 __func__
, bcn_channel
,
912 Adapter
->mlmeextpriv
.cur_channel
);
917 p
= cfg80211_find_ie(WLAN_EID_SSID
, mgmt
->u
.beacon
.variable
, pie_len
);
922 DBG_8723A("%s marc: cannot find SSID for survey event\n",
928 RT_TRACE(_module_rtl871x_mlme_c_
, _drv_info_
,
929 "%s bssid.Ssid.Ssid:%s bssid.Ssid.SsidLength:%d cur_network->network.Ssid.Ssid:%s len:%d\n",
930 __func__
, ssid
, ssid_len
, cur_network
->network
.Ssid
.ssid
,
931 cur_network
->network
.Ssid
.ssid_len
);
933 if (ssid_len
!= cur_network
->network
.Ssid
.ssid_len
|| ssid_len
> 32 ||
935 memcmp(ssid
, cur_network
->network
.Ssid
.ssid
, ssid_len
))) {
936 DBG_8723A("%s(), SSID is not match return FAIL\n", __func__
);
940 /* check encryption info */
941 val16
= le16_to_cpu(mgmt
->u
.beacon
.capab_info
);
943 if (val16
& WLAN_CAPABILITY_PRIVACY
)
948 RT_TRACE(_module_rtl871x_mlme_c_
, _drv_info_
,
949 "%s(): cur_network->network.Privacy is %d, bssid.Privacy is %d\n",
950 __func__
, cur_network
->network
.Privacy
, privacy
);
951 if (cur_network
->network
.Privacy
!= privacy
) {
952 DBG_8723A("%s(), privacy is not match return FAIL\n", __func__
);
956 p
= cfg80211_find_ie(WLAN_EID_RSN
, mgmt
->u
.beacon
.variable
, pie_len
);
958 crypto
= ENCRYP_PROTOCOL_WPA2
;
960 r
= rtw_parse_wpa2_ie23a(p
, p
[1] + 2, &group_cipher
,
961 &pairwise_cipher
, &is_8021x
);
963 RT_TRACE(_module_rtl871x_mlme_c_
, _drv_info_
,
964 "%s pnetwork->pairwise_cipher: %d, pnetwork->group_cipher: %d, is_802x : %d\n",
965 __func__
, pairwise_cipher
,
966 group_cipher
, is_8021x
);
969 p
= cfg80211_find_vendor_ie(WLAN_OUI_MICROSOFT
,
970 WLAN_OUI_TYPE_MICROSOFT_WPA
,
971 mgmt
->u
.beacon
.variable
, pie_len
);
973 crypto
= ENCRYP_PROTOCOL_WPA
;
974 r
= rtw_parse_wpa_ie23a(p
, p
[1] + 2, &group_cipher
,
975 &pairwise_cipher
, &is_8021x
);
977 RT_TRACE(_module_rtl871x_mlme_c_
, _drv_info_
,
978 "%s pnetwork->pairwise_cipher: %d, group_cipher is %d, is_8021x is %d\n",
979 __func__
, pairwise_cipher
,
980 group_cipher
, is_8021x
);
983 crypto
= ENCRYP_PROTOCOL_WEP
;
985 crypto
= ENCRYP_PROTOCOL_OPENSYS
;
989 if (cur_network
->BcnInfo
.encryp_protocol
!= crypto
) {
990 DBG_8723A("%s(): encryption mismatch, return FAIL\n", __func__
);
994 if (crypto
== ENCRYP_PROTOCOL_WPA
|| crypto
== ENCRYP_PROTOCOL_WPA2
) {
995 RT_TRACE(_module_rtl871x_mlme_c_
, _drv_err_
,
996 "%s cur_network->group_cipher is %d: %d\n", __func__
,
997 cur_network
->BcnInfo
.group_cipher
, group_cipher
);
998 if (pairwise_cipher
!= cur_network
->BcnInfo
.pairwise_cipher
||
999 group_cipher
!= cur_network
->BcnInfo
.group_cipher
) {
1000 DBG_8723A("%s pairwise_cipher(%x:%x) or group_cipher "
1001 "(%x:%x) is not match, return FAIL\n",
1002 __func__
, pairwise_cipher
,
1003 cur_network
->BcnInfo
.pairwise_cipher
,
1005 cur_network
->BcnInfo
.group_cipher
);
1009 if (is_8021x
!= cur_network
->BcnInfo
.is_8021x
) {
1010 DBG_8723A("%s authentication is not match, return "
1011 "FAIL\n", __func__
);
1023 void update_beacon23a_info(struct rtw_adapter
*padapter
,
1024 struct ieee80211_mgmt
*mgmt
,
1025 uint pkt_len
, struct sta_info
*psta
)
1030 len
= pkt_len
- offsetof(struct ieee80211_mgmt
, u
.beacon
.variable
);
1032 p
= cfg80211_find_ie(WLAN_EID_HT_OPERATION
, mgmt
->u
.beacon
.variable
,
1035 bwmode_update_check(padapter
, p
);
1037 p
= cfg80211_find_ie(WLAN_EID_ERP_INFO
, mgmt
->u
.beacon
.variable
, len
);
1039 ERP_IE_handler23a(padapter
, p
);
1040 VCS_update23a(padapter
, psta
);
1044 bool is_ap_in_tkip23a(struct rtw_adapter
*padapter
)
1047 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1048 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1049 struct wlan_bssid_ex
*cur_network
= &pmlmeinfo
->network
;
1052 if (cur_network
->capability
& WLAN_CAPABILITY_PRIVACY
) {
1053 for (i
= 0; i
< pmlmeinfo
->network
.IELength
;) {
1054 p
= pmlmeinfo
->network
.IEs
+ i
;
1057 case WLAN_EID_VENDOR_SPECIFIC
:
1058 if (!memcmp(p
+ 2, RTW_WPA_OUI23A_TYPE
, 4) &&
1059 !memcmp(p
+ 2 + 12, WPA_TKIP_CIPHER
, 4))
1063 if (!memcmp(p
+ 2 + 8, RSN_TKIP_CIPHER
, 4))
1076 bool should_forbid_n_rate23a(struct rtw_adapter
*padapter
)
1079 struct mlme_priv
*pmlmepriv
= &padapter
->mlmepriv
;
1080 struct wlan_bssid_ex
*cur_network
= &pmlmepriv
->cur_network
.network
;
1083 if (cur_network
->capability
& WLAN_CAPABILITY_PRIVACY
) {
1084 for (i
= 0; i
< cur_network
->IELength
;) {
1085 p
= cur_network
->IEs
+ i
;
1088 case WLAN_EID_VENDOR_SPECIFIC
:
1089 if (!memcmp(p
+ 2, RTW_WPA_OUI23A_TYPE
, 4) &&
1090 (!memcmp(p
+ 2 + 12,
1091 WPA_CIPHER_SUITE_CCMP23A
, 4) ||
1093 WPA_CIPHER_SUITE_CCMP23A
, 4)))
1097 if (!memcmp(p
+ 2 + 8,
1098 RSN_CIPHER_SUITE_CCMP23A
, 4) ||
1100 RSN_CIPHER_SUITE_CCMP23A
, 4))
1114 bool is_ap_in_wep23a(struct rtw_adapter
*padapter
)
1117 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1118 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1119 struct wlan_bssid_ex
*cur_network
= &pmlmeinfo
->network
;
1122 if (cur_network
->capability
& WLAN_CAPABILITY_PRIVACY
) {
1123 for (i
= 0; i
< pmlmeinfo
->network
.IELength
;) {
1124 p
= pmlmeinfo
->network
.IEs
+ i
;
1127 case WLAN_EID_VENDOR_SPECIFIC
:
1128 if (!memcmp(p
+ 2, RTW_WPA_OUI23A_TYPE
, 4))
1146 static int wifirate2_ratetbl_inx23a(unsigned char rate
)
1193 unsigned int update_basic_rate23a(unsigned char *ptn
, unsigned int ptn_sz
)
1195 unsigned int i
, num_of_rate
;
1196 unsigned int mask
= 0;
1198 num_of_rate
= (ptn_sz
> NumRates
)? NumRates
: ptn_sz
;
1200 for (i
= 0; i
< num_of_rate
; i
++) {
1201 if ((*(ptn
+ i
)) & 0x80)
1202 mask
|= 0x1 << wifirate2_ratetbl_inx23a(*(ptn
+ i
));
1207 unsigned int update_supported_rate23a(unsigned char *ptn
, unsigned int ptn_sz
)
1209 unsigned int i
, num_of_rate
;
1210 unsigned int mask
= 0;
1212 num_of_rate
= (ptn_sz
> NumRates
) ? NumRates
: ptn_sz
;
1214 for (i
= 0; i
< num_of_rate
; i
++)
1215 mask
|= 0x1 << wifirate2_ratetbl_inx23a(*(ptn
+ i
));
1219 unsigned int update_MSC_rate23a(struct ieee80211_ht_cap
*pHT_caps
)
1221 unsigned int mask
= 0;
1223 mask
= pHT_caps
->mcs
.rx_mask
[0] << 12 |
1224 pHT_caps
->mcs
.rx_mask
[1] << 20;
1229 int support_short_GI23a(struct rtw_adapter
*padapter
,
1230 struct ieee80211_ht_cap
*pHT_caps
)
1232 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1233 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1234 unsigned char bit_offset
;
1236 if (!pmlmeinfo
->HT_enable
)
1238 if (pmlmeinfo
->assoc_AP_vendor
== HT_IOT_PEER_RALINK
)
1240 bit_offset
= (pmlmeext
->cur_bwmode
& HT_CHANNEL_WIDTH_40
)? 6: 5;
1242 if (pHT_caps
->cap_info
& cpu_to_le16(0x1 << bit_offset
))
1248 unsigned char get_highest_rate_idx23a(u32 mask
)
1251 unsigned char rate_idx
= 0;
1253 for (i
= 27; i
>= 0; i
--) {
1254 if (mask
& BIT(i
)) {
1262 void Update_RA_Entry23a(struct rtw_adapter
*padapter
, struct sta_info
*psta
)
1264 rtw_hal_update_ra_mask23a(psta
, 0);
1267 static void enable_rate_adaptive(struct rtw_adapter
*padapter
,
1268 struct sta_info
*psta
)
1270 Update_RA_Entry23a(padapter
, psta
);
1273 void set_sta_rate23a(struct rtw_adapter
*padapter
, struct sta_info
*psta
)
1276 enable_rate_adaptive(padapter
, psta
);
1279 /* Update RRSR and Rate for USERATE */
1280 void update_tx_basic_rate23a(struct rtw_adapter
*padapter
, u8 wirelessmode
)
1282 unsigned char supported_rates
[NDIS_802_11_LENGTH_RATES_EX
];
1284 memset(supported_rates
, 0, NDIS_802_11_LENGTH_RATES_EX
);
1286 if (wirelessmode
== WIRELESS_11B
) {
1287 memcpy(supported_rates
, rtw_basic_rate_cck
, 4);
1288 } else if (wirelessmode
& WIRELESS_11B
) {
1289 memcpy(supported_rates
, rtw_basic_rate_mix
, 7);
1291 memcpy(supported_rates
, rtw_basic_rate_ofdm
, 3);
1294 if (wirelessmode
& WIRELESS_11B
)
1295 update_mgnt_tx_rate23a(padapter
, IEEE80211_CCK_RATE_1MB
);
1297 update_mgnt_tx_rate23a(padapter
, IEEE80211_OFDM_RATE_6MB
);
1299 HalSetBrateCfg23a(padapter
, supported_rates
);
1302 unsigned char check_assoc_AP23a(u8
*pframe
, uint len
)
1305 u8 epigram_vendor_flag
;
1306 u8 ralink_vendor_flag
;
1309 epigram_vendor_flag
= 0;
1310 ralink_vendor_flag
= 0;
1312 for (i
= 0; i
< len
;) {
1316 case WLAN_EID_VENDOR_SPECIFIC
:
1317 if (!memcmp(p
+ 2, ARTHEROS_OUI1
, 3) ||
1318 !memcmp(p
+ 2, ARTHEROS_OUI2
, 3)) {
1319 DBG_8723A("link to Artheros AP\n");
1320 return HT_IOT_PEER_ATHEROS
;
1321 } else if (!memcmp(p
+ 2, BROADCOM_OUI1
, 3) ||
1322 !memcmp(p
+ 2, BROADCOM_OUI2
, 3)) {
1323 DBG_8723A("link to Broadcom AP\n");
1324 return HT_IOT_PEER_BROADCOM
;
1325 } else if (!memcmp(p
+ 2, MARVELL_OUI
, 3)) {
1326 DBG_8723A("link to Marvell AP\n");
1327 return HT_IOT_PEER_MARVELL
;
1328 } else if (!memcmp(p
+ 2, RALINK_OUI
, 3)) {
1329 if (!ralink_vendor_flag
)
1330 ralink_vendor_flag
= 1;
1332 DBG_8723A("link to Ralink AP\n");
1333 return HT_IOT_PEER_RALINK
;
1335 } else if (!memcmp(p
+ 2, CISCO_OUI
, 3)) {
1336 DBG_8723A("link to Cisco AP\n");
1337 return HT_IOT_PEER_CISCO
;
1338 } else if (!memcmp(p
+ 2, REALTEK_OUI
, 3)) {
1339 DBG_8723A("link to Realtek 96B\n");
1340 return HT_IOT_PEER_REALTEK
;
1341 } else if (!memcmp(p
+ 2, AIRGOCAP_OUI
, 3)) {
1342 DBG_8723A("link to Airgo Cap\n");
1343 return HT_IOT_PEER_AIRGO
;
1344 } else if (!memcmp(p
+ 2, EPIGRAM_OUI
, 3)) {
1345 epigram_vendor_flag
= 1;
1346 if (ralink_vendor_flag
) {
1347 DBG_8723A("link to Tenda W311R AP\n");
1348 return HT_IOT_PEER_TENDA
;
1350 DBG_8723A("Capture EPIGRAM_OUI\n");
1360 if (ralink_vendor_flag
&& !epigram_vendor_flag
) {
1361 DBG_8723A("link to Ralink AP\n");
1362 return HT_IOT_PEER_RALINK
;
1363 } else if (ralink_vendor_flag
&& epigram_vendor_flag
) {
1364 DBG_8723A("link to Tenda W311R AP\n");
1365 return HT_IOT_PEER_TENDA
;
1367 DBG_8723A("link to new AP\n");
1368 return HT_IOT_PEER_UNKNOWN
;
1372 void update_IOT_info23a(struct rtw_adapter
*padapter
)
1374 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1375 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1377 switch (pmlmeinfo
->assoc_AP_vendor
) {
1378 case HT_IOT_PEER_MARVELL
:
1379 pmlmeinfo
->turboMode_cts2self
= 1;
1380 pmlmeinfo
->turboMode_rtsen
= 0;
1382 case HT_IOT_PEER_RALINK
:
1383 pmlmeinfo
->turboMode_cts2self
= 0;
1384 pmlmeinfo
->turboMode_rtsen
= 1;
1385 /* disable high power */
1386 rtl8723a_odm_support_ability_clr(padapter
, (u32
)
1387 ~DYNAMIC_BB_DYNAMIC_TXPWR
);
1389 case HT_IOT_PEER_REALTEK
:
1390 /* rtw_write16(padapter, 0x4cc, 0xffff); */
1391 /* rtw_write16(padapter, 0x546, 0x01c0); */
1392 /* disable high power */
1393 rtl8723a_odm_support_ability_clr(padapter
, (u32
)
1394 ~DYNAMIC_BB_DYNAMIC_TXPWR
);
1397 pmlmeinfo
->turboMode_cts2self
= 0;
1398 pmlmeinfo
->turboMode_rtsen
= 1;
1403 void update_capinfo23a(struct rtw_adapter
*Adapter
, u16 updateCap
)
1405 struct mlme_ext_priv
*pmlmeext
= &Adapter
->mlmeextpriv
;
1406 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1408 if (updateCap
& cShortPreamble
) {
1409 /* Short Preamble */
1410 if (pmlmeinfo
->preamble_mode
!= PREAMBLE_SHORT
) {
1411 /* PREAMBLE_LONG or PREAMBLE_AUTO */
1412 pmlmeinfo
->preamble_mode
= PREAMBLE_SHORT
;
1413 rtl8723a_ack_preamble(Adapter
, true);
1415 } else { /* Long Preamble */
1416 if (pmlmeinfo
->preamble_mode
!= PREAMBLE_LONG
) {
1417 /* PREAMBLE_SHORT or PREAMBLE_AUTO */
1418 pmlmeinfo
->preamble_mode
= PREAMBLE_LONG
;
1419 rtl8723a_ack_preamble(Adapter
, false);
1422 if (updateCap
& cIBSS
) {
1423 /* Filen: See 802.11-2007 p.91 */
1424 pmlmeinfo
->slotTime
= NON_SHORT_SLOT_TIME
;
1426 /* Filen: See 802.11-2007 p.90 */
1427 if (pmlmeext
->cur_wireless_mode
&
1428 (WIRELESS_11G
| WIRELESS_11_24N
)) {
1429 if (updateCap
& cShortSlotTime
) { /* Short Slot Time */
1430 if (pmlmeinfo
->slotTime
!= SHORT_SLOT_TIME
)
1431 pmlmeinfo
->slotTime
= SHORT_SLOT_TIME
;
1432 } else { /* Long Slot Time */
1433 if (pmlmeinfo
->slotTime
!= NON_SHORT_SLOT_TIME
)
1434 pmlmeinfo
->slotTime
=
1435 NON_SHORT_SLOT_TIME
;
1437 } else if (pmlmeext
->cur_wireless_mode
&
1438 (WIRELESS_11A
| WIRELESS_11_5N
)) {
1439 pmlmeinfo
->slotTime
= SHORT_SLOT_TIME
;
1442 pmlmeinfo
->slotTime
= NON_SHORT_SLOT_TIME
;
1445 rtl8723a_set_slot_time(Adapter
, pmlmeinfo
->slotTime
);
1448 void update_wireless_mode23a(struct rtw_adapter
*padapter
)
1450 int ratelen
, network_type
= 0;
1451 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1452 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1453 struct wlan_bssid_ex
*cur_network
= &pmlmeinfo
->network
;
1454 unsigned char *rate
= cur_network
->SupportedRates
;
1456 ratelen
= rtw_get_rateset_len23a(cur_network
->SupportedRates
);
1458 if ((pmlmeinfo
->HT_info_enable
) && (pmlmeinfo
->HT_caps_enable
))
1459 pmlmeinfo
->HT_enable
= 1;
1461 if (pmlmeext
->cur_channel
> 14) {
1462 if (pmlmeinfo
->HT_enable
)
1463 network_type
= WIRELESS_11_5N
;
1464 network_type
|= WIRELESS_11A
;
1466 if (pmlmeinfo
->HT_enable
)
1467 network_type
= WIRELESS_11_24N
;
1469 if (cckratesonly_included23a(rate
, ratelen
) == true)
1470 network_type
|= WIRELESS_11B
;
1471 else if (cckrates_included23a(rate
, ratelen
) == true)
1472 network_type
|= WIRELESS_11BG
;
1474 network_type
|= WIRELESS_11G
;
1477 pmlmeext
->cur_wireless_mode
=
1478 network_type
& padapter
->registrypriv
.wireless_mode
;
1480 /* 0x0808 -> for CCK, 0x0a0a -> for OFDM */
1481 /* change this value if having IOT issues. */
1482 rtl8723a_set_resp_sifs(padapter
, 0x08, 0x08, 0x0a, 0x0a);
1484 if (pmlmeext
->cur_wireless_mode
& WIRELESS_11B
)
1485 update_mgnt_tx_rate23a(padapter
, IEEE80211_CCK_RATE_1MB
);
1487 update_mgnt_tx_rate23a(padapter
, IEEE80211_OFDM_RATE_6MB
);
1490 void update_bmc_sta_support_rate23a(struct rtw_adapter
*padapter
, u32 mac_id
)
1492 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1493 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1495 if (pmlmeext
->cur_wireless_mode
& WIRELESS_11B
) {
1496 /* Only B, B/G, and B/G/N AP could use CCK rate */
1497 memcpy((pmlmeinfo
->FW_sta_info
[mac_id
].SupportedRates
),
1498 rtw_basic_rate_cck
, 4);
1500 memcpy(pmlmeinfo
->FW_sta_info
[mac_id
].SupportedRates
,
1501 rtw_basic_rate_ofdm
, 3);
1505 int update_sta_support_rate23a(struct rtw_adapter
*padapter
, u8
*pvar_ie
,
1506 uint var_ie_len
, int cam_idx
)
1508 int supportRateNum
= 0;
1509 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1510 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1513 p
= cfg80211_find_ie(WLAN_EID_SUPP_RATES
, pvar_ie
, var_ie_len
);
1517 memcpy(pmlmeinfo
->FW_sta_info
[cam_idx
].SupportedRates
, p
+ 2, p
[1]);
1518 supportRateNum
= p
[1];
1520 p
= cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES
, pvar_ie
, var_ie_len
);
1522 memcpy(pmlmeinfo
->FW_sta_info
[cam_idx
].SupportedRates
+
1523 supportRateNum
, p
+ 2, p
[1]);
1527 void process_addba_req23a(struct rtw_adapter
*padapter
,
1528 u8
*paddba_req
, u8
*addr
)
1530 struct sta_info
*psta
;
1531 u16 tid
, start_seq
, param
;
1532 struct recv_reorder_ctrl
*preorder_ctrl
;
1533 struct sta_priv
*pstapriv
= &padapter
->stapriv
;
1534 struct ADDBA_request
*preq
= (struct ADDBA_request
*)paddba_req
;
1535 struct mlme_ext_priv
*pmlmeext
= &padapter
->mlmeextpriv
;
1536 struct mlme_ext_info
*pmlmeinfo
= &pmlmeext
->mlmext_info
;
1538 psta
= rtw_get_stainfo23a(pstapriv
, addr
);
1541 start_seq
= le16_to_cpu(preq
->BA_starting_seqctrl
) >> 4;
1543 param
= le16_to_cpu(preq
->BA_para_set
);
1544 tid
= (param
>> 2) & 0x0f;
1546 preorder_ctrl
= &psta
->recvreorder_ctrl
[tid
];
1548 preorder_ctrl
->indicate_seq
= 0xffff;
1550 preorder_ctrl
->enable
= (pmlmeinfo
->bAcceptAddbaReq
== true) ?