158391efdSNathan Chancellor // SPDX-License-Identifier: GPL-2.0
2554c0a3aSHans de Goede /******************************************************************************
3554c0a3aSHans de Goede *
4554c0a3aSHans de Goede * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
5554c0a3aSHans de Goede *
6554c0a3aSHans de Goede ******************************************************************************/
7554c0a3aSHans de Goede
8554c0a3aSHans de Goede #include <drv_types.h>
9554c0a3aSHans de Goede #include <rtw_debug.h>
10554c0a3aSHans de Goede #include <hal_com_h2c.h>
11554c0a3aSHans de Goede
12554c0a3aSHans de Goede static unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f};
13554c0a3aSHans de Goede static unsigned char ARTHEROS_OUI2[] = {0x00, 0x13, 0x74};
14554c0a3aSHans de Goede
15554c0a3aSHans de Goede static unsigned char BROADCOM_OUI1[] = {0x00, 0x10, 0x18};
16554c0a3aSHans de Goede static unsigned char BROADCOM_OUI2[] = {0x00, 0x0a, 0xf7};
17554c0a3aSHans de Goede static unsigned char BROADCOM_OUI3[] = {0x00, 0x05, 0xb5};
18554c0a3aSHans de Goede
19554c0a3aSHans de Goede static unsigned char CISCO_OUI[] = {0x00, 0x40, 0x96};
20554c0a3aSHans de Goede static unsigned char MARVELL_OUI[] = {0x00, 0x50, 0x43};
21554c0a3aSHans de Goede static unsigned char RALINK_OUI[] = {0x00, 0x0c, 0x43};
22554c0a3aSHans de Goede static unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c};
23554c0a3aSHans de Goede static unsigned char AIRGOCAP_OUI[] = {0x00, 0x0a, 0xf5};
24554c0a3aSHans de Goede static unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02};
25554c0a3aSHans de Goede static unsigned char WPA_TKIP_CIPHER[4] = {0x00, 0x50, 0xf2, 0x02};
26554c0a3aSHans de Goede
27554c0a3aSHans de Goede /* define WAIT_FOR_BCN_TO_MIN (3000) */
28554c0a3aSHans de Goede #define WAIT_FOR_BCN_TO_MIN (6000)
29554c0a3aSHans de Goede #define WAIT_FOR_BCN_TO_MAX (20000)
30554c0a3aSHans de Goede
31554c0a3aSHans de Goede #define DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS 1000
32554c0a3aSHans de Goede #define DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD 3
33554c0a3aSHans de Goede
34554c0a3aSHans de Goede static u8 rtw_basic_rate_cck[4] = {
35a35115f3SMichael Straube IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK,
36a35115f3SMichael Straube IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK,
37a35115f3SMichael Straube IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK,
38a35115f3SMichael Straube IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK
39554c0a3aSHans de Goede };
40554c0a3aSHans de Goede
41554c0a3aSHans de Goede static u8 rtw_basic_rate_ofdm[3] = {
42a35115f3SMichael Straube IEEE80211_OFDM_RATE_6MB | IEEE80211_BASIC_RATE_MASK,
43a35115f3SMichael Straube IEEE80211_OFDM_RATE_12MB | IEEE80211_BASIC_RATE_MASK,
44554c0a3aSHans de Goede IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK
45554c0a3aSHans de Goede };
46554c0a3aSHans de Goede
networktype_to_raid_ex(struct adapter * adapter,struct sta_info * psta)47554c0a3aSHans de Goede u8 networktype_to_raid_ex(struct adapter *adapter, struct sta_info *psta)
48554c0a3aSHans de Goede {
4924e65aacSFabio Aiuto u8 raid;
50554c0a3aSHans de Goede
51554c0a3aSHans de Goede switch (psta->wireless_mode) {
52554c0a3aSHans de Goede case WIRELESS_11B:
53554c0a3aSHans de Goede raid = RATEID_IDX_B;
54554c0a3aSHans de Goede break;
55554c0a3aSHans de Goede case WIRELESS_11G:
56554c0a3aSHans de Goede raid = RATEID_IDX_G;
57554c0a3aSHans de Goede break;
58554c0a3aSHans de Goede case WIRELESS_11BG:
59554c0a3aSHans de Goede raid = RATEID_IDX_BG;
60554c0a3aSHans de Goede break;
61554c0a3aSHans de Goede case WIRELESS_11_24N:
62554c0a3aSHans de Goede case WIRELESS_11G_24N:
63554c0a3aSHans de Goede raid = RATEID_IDX_GN_N1SS;
64554c0a3aSHans de Goede break;
65554c0a3aSHans de Goede case WIRELESS_11B_24N:
66554c0a3aSHans de Goede case WIRELESS_11BG_24N:
67554c0a3aSHans de Goede if (psta->bw_mode == CHANNEL_WIDTH_20) {
68554c0a3aSHans de Goede raid = RATEID_IDX_BGN_20M_1SS_BN;
69554c0a3aSHans de Goede } else {
70554c0a3aSHans de Goede raid = RATEID_IDX_BGN_40M_1SS;
71554c0a3aSHans de Goede }
72554c0a3aSHans de Goede break;
73554c0a3aSHans de Goede default:
74554c0a3aSHans de Goede raid = RATEID_IDX_BGN_40M_2SS;
75554c0a3aSHans de Goede break;
76554c0a3aSHans de Goede }
77554c0a3aSHans de Goede return raid;
78554c0a3aSHans de Goede }
79554c0a3aSHans de Goede
80554c0a3aSHans de Goede unsigned char ratetbl_val_2wifirate(unsigned char rate);
ratetbl_val_2wifirate(unsigned char rate)81554c0a3aSHans de Goede unsigned char ratetbl_val_2wifirate(unsigned char rate)
82554c0a3aSHans de Goede {
83554c0a3aSHans de Goede switch (rate & 0x7f) {
84554c0a3aSHans de Goede case 0:
85f0de833aSMichael Straube return IEEE80211_CCK_RATE_1MB;
86554c0a3aSHans de Goede case 1:
87f0de833aSMichael Straube return IEEE80211_CCK_RATE_2MB;
88554c0a3aSHans de Goede case 2:
89f0de833aSMichael Straube return IEEE80211_CCK_RATE_5MB;
90554c0a3aSHans de Goede case 3:
91f0de833aSMichael Straube return IEEE80211_CCK_RATE_11MB;
92554c0a3aSHans de Goede case 4:
93f0de833aSMichael Straube return IEEE80211_OFDM_RATE_6MB;
94554c0a3aSHans de Goede case 5:
95f0de833aSMichael Straube return IEEE80211_OFDM_RATE_9MB;
96554c0a3aSHans de Goede case 6:
97f0de833aSMichael Straube return IEEE80211_OFDM_RATE_12MB;
98554c0a3aSHans de Goede case 7:
99f0de833aSMichael Straube return IEEE80211_OFDM_RATE_18MB;
100554c0a3aSHans de Goede case 8:
101f0de833aSMichael Straube return IEEE80211_OFDM_RATE_24MB;
102554c0a3aSHans de Goede case 9:
103f0de833aSMichael Straube return IEEE80211_OFDM_RATE_36MB;
104554c0a3aSHans de Goede case 10:
105f0de833aSMichael Straube return IEEE80211_OFDM_RATE_48MB;
106554c0a3aSHans de Goede case 11:
107f0de833aSMichael Straube return IEEE80211_OFDM_RATE_54MB;
108f0de833aSMichael Straube default:
109f0de833aSMichael Straube return 0;
110554c0a3aSHans de Goede }
111554c0a3aSHans de Goede }
112554c0a3aSHans de Goede
113554c0a3aSHans de Goede int is_basicrate(struct adapter *padapter, unsigned char rate);
is_basicrate(struct adapter * padapter,unsigned char rate)114554c0a3aSHans de Goede int is_basicrate(struct adapter *padapter, unsigned char rate)
115554c0a3aSHans de Goede {
116554c0a3aSHans de Goede int i;
117554c0a3aSHans de Goede unsigned char val;
118554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
119554c0a3aSHans de Goede
120554c0a3aSHans de Goede for (i = 0; i < NumRates; i++) {
121554c0a3aSHans de Goede val = pmlmeext->basicrate[i];
122554c0a3aSHans de Goede
123554c0a3aSHans de Goede if ((val != 0xff) && (val != 0xfe))
124554c0a3aSHans de Goede if (rate == ratetbl_val_2wifirate(val))
125554c0a3aSHans de Goede return true;
126554c0a3aSHans de Goede }
127554c0a3aSHans de Goede
128554c0a3aSHans de Goede return false;
129554c0a3aSHans de Goede }
130554c0a3aSHans de Goede
131554c0a3aSHans de Goede unsigned int ratetbl2rateset(struct adapter *padapter, unsigned char *rateset);
ratetbl2rateset(struct adapter * padapter,unsigned char * rateset)132554c0a3aSHans de Goede unsigned int ratetbl2rateset(struct adapter *padapter, unsigned char *rateset)
133554c0a3aSHans de Goede {
134554c0a3aSHans de Goede int i;
135554c0a3aSHans de Goede unsigned char rate;
136554c0a3aSHans de Goede unsigned int len = 0;
137554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
138554c0a3aSHans de Goede
139554c0a3aSHans de Goede for (i = 0; i < NumRates; i++) {
140554c0a3aSHans de Goede rate = pmlmeext->datarate[i];
141554c0a3aSHans de Goede
142554c0a3aSHans de Goede switch (rate) {
143554c0a3aSHans de Goede case 0xff:
144554c0a3aSHans de Goede return len;
145554c0a3aSHans de Goede
146554c0a3aSHans de Goede case 0xfe:
147554c0a3aSHans de Goede continue;
148554c0a3aSHans de Goede
149554c0a3aSHans de Goede default:
150554c0a3aSHans de Goede rate = ratetbl_val_2wifirate(rate);
151554c0a3aSHans de Goede
152554c0a3aSHans de Goede if (is_basicrate(padapter, rate) == true)
153554c0a3aSHans de Goede rate |= IEEE80211_BASIC_RATE_MASK;
154554c0a3aSHans de Goede
155554c0a3aSHans de Goede rateset[len] = rate;
156554c0a3aSHans de Goede len++;
157554c0a3aSHans de Goede break;
158554c0a3aSHans de Goede }
159554c0a3aSHans de Goede }
160554c0a3aSHans de Goede return len;
161554c0a3aSHans de Goede }
162554c0a3aSHans de Goede
get_rate_set(struct adapter * padapter,unsigned char * pbssrate,int * bssrate_len)163554c0a3aSHans de Goede void get_rate_set(struct adapter *padapter, unsigned char *pbssrate, int *bssrate_len)
164554c0a3aSHans de Goede {
165554c0a3aSHans de Goede unsigned char supportedrates[NumRates];
166554c0a3aSHans de Goede
167554c0a3aSHans de Goede memset(supportedrates, 0, NumRates);
168554c0a3aSHans de Goede *bssrate_len = ratetbl2rateset(padapter, supportedrates);
169554c0a3aSHans de Goede memcpy(pbssrate, supportedrates, *bssrate_len);
170554c0a3aSHans de Goede }
171554c0a3aSHans de Goede
set_mcs_rate_by_mask(u8 * mcs_set,u32 mask)172554c0a3aSHans de Goede void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask)
173554c0a3aSHans de Goede {
174554c0a3aSHans de Goede u8 mcs_rate_1r = (u8)(mask&0xff);
175554c0a3aSHans de Goede u8 mcs_rate_2r = (u8)((mask>>8)&0xff);
176554c0a3aSHans de Goede u8 mcs_rate_3r = (u8)((mask>>16)&0xff);
177554c0a3aSHans de Goede u8 mcs_rate_4r = (u8)((mask>>24)&0xff);
178554c0a3aSHans de Goede
179554c0a3aSHans de Goede mcs_set[0] &= mcs_rate_1r;
180554c0a3aSHans de Goede mcs_set[1] &= mcs_rate_2r;
181554c0a3aSHans de Goede mcs_set[2] &= mcs_rate_3r;
182554c0a3aSHans de Goede mcs_set[3] &= mcs_rate_4r;
183554c0a3aSHans de Goede }
184554c0a3aSHans de Goede
UpdateBrateTbl(struct adapter * Adapter,u8 * mBratesOS)185554c0a3aSHans de Goede void UpdateBrateTbl(struct adapter *Adapter, u8 *mBratesOS)
186554c0a3aSHans de Goede {
187554c0a3aSHans de Goede u8 i;
188554c0a3aSHans de Goede u8 rate;
189554c0a3aSHans de Goede
190554c0a3aSHans de Goede /* 1M, 2M, 5.5M, 11M, 6M, 12M, 24M are mandatory. */
191554c0a3aSHans de Goede for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) {
192554c0a3aSHans de Goede rate = mBratesOS[i] & 0x7f;
193554c0a3aSHans de Goede switch (rate) {
194554c0a3aSHans de Goede case IEEE80211_CCK_RATE_1MB:
195554c0a3aSHans de Goede case IEEE80211_CCK_RATE_2MB:
196554c0a3aSHans de Goede case IEEE80211_CCK_RATE_5MB:
197554c0a3aSHans de Goede case IEEE80211_CCK_RATE_11MB:
198554c0a3aSHans de Goede case IEEE80211_OFDM_RATE_6MB:
199554c0a3aSHans de Goede case IEEE80211_OFDM_RATE_12MB:
200554c0a3aSHans de Goede case IEEE80211_OFDM_RATE_24MB:
201554c0a3aSHans de Goede mBratesOS[i] |= IEEE80211_BASIC_RATE_MASK;
202554c0a3aSHans de Goede break;
203554c0a3aSHans de Goede }
204554c0a3aSHans de Goede }
205554c0a3aSHans de Goede }
206554c0a3aSHans de Goede
UpdateBrateTblForSoftAP(u8 * bssrateset,u32 bssratelen)207554c0a3aSHans de Goede void UpdateBrateTblForSoftAP(u8 *bssrateset, u32 bssratelen)
208554c0a3aSHans de Goede {
209554c0a3aSHans de Goede u8 i;
210554c0a3aSHans de Goede u8 rate;
211554c0a3aSHans de Goede
212554c0a3aSHans de Goede for (i = 0; i < bssratelen; i++) {
213554c0a3aSHans de Goede rate = bssrateset[i] & 0x7f;
214554c0a3aSHans de Goede switch (rate) {
215554c0a3aSHans de Goede case IEEE80211_CCK_RATE_1MB:
216554c0a3aSHans de Goede case IEEE80211_CCK_RATE_2MB:
217554c0a3aSHans de Goede case IEEE80211_CCK_RATE_5MB:
218554c0a3aSHans de Goede case IEEE80211_CCK_RATE_11MB:
219554c0a3aSHans de Goede bssrateset[i] |= IEEE80211_BASIC_RATE_MASK;
220554c0a3aSHans de Goede break;
221554c0a3aSHans de Goede }
222554c0a3aSHans de Goede }
223554c0a3aSHans de Goede }
224554c0a3aSHans de Goede
Save_DM_Func_Flag(struct adapter * padapter)225554c0a3aSHans de Goede void Save_DM_Func_Flag(struct adapter *padapter)
226554c0a3aSHans de Goede {
227554c0a3aSHans de Goede u8 bSaveFlag = true;
22822045712SRoss Schmidt
229554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag));
230554c0a3aSHans de Goede }
231554c0a3aSHans de Goede
Restore_DM_Func_Flag(struct adapter * padapter)232554c0a3aSHans de Goede void Restore_DM_Func_Flag(struct adapter *padapter)
233554c0a3aSHans de Goede {
234554c0a3aSHans de Goede u8 bSaveFlag = false;
23522045712SRoss Schmidt
236554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_OP, (u8 *)(&bSaveFlag));
237554c0a3aSHans de Goede }
238554c0a3aSHans de Goede
Switch_DM_Func(struct adapter * padapter,u32 mode,u8 enable)239554c0a3aSHans de Goede void Switch_DM_Func(struct adapter *padapter, u32 mode, u8 enable)
240554c0a3aSHans de Goede {
241554c0a3aSHans de Goede if (enable == true)
242554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_SET, (u8 *)(&mode));
243554c0a3aSHans de Goede else
244554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_DM_FUNC_CLR, (u8 *)(&mode));
245554c0a3aSHans de Goede }
246554c0a3aSHans de Goede
Set_MSR(struct adapter * padapter,u8 type)247554c0a3aSHans de Goede void Set_MSR(struct adapter *padapter, u8 type)
248554c0a3aSHans de Goede {
249eb569cc0SNishka Dasgupta rtw_hal_set_hwreg(padapter, HW_VAR_MEDIA_STATUS, (u8 *)(&type));
250554c0a3aSHans de Goede }
251554c0a3aSHans de Goede
rtw_get_oper_ch(struct adapter * adapter)252554c0a3aSHans de Goede inline u8 rtw_get_oper_ch(struct adapter *adapter)
253554c0a3aSHans de Goede {
254554c0a3aSHans de Goede return adapter_to_dvobj(adapter)->oper_channel;
255554c0a3aSHans de Goede }
256554c0a3aSHans de Goede
rtw_set_oper_ch(struct adapter * adapter,u8 ch)257554c0a3aSHans de Goede inline void rtw_set_oper_ch(struct adapter *adapter, u8 ch)
258554c0a3aSHans de Goede {
259554c0a3aSHans de Goede #ifdef DBG_CH_SWITCH
260554c0a3aSHans de Goede const int len = 128;
261554c0a3aSHans de Goede char msg[128] = {0};
262554c0a3aSHans de Goede int cnt = 0;
263554c0a3aSHans de Goede int i = 0;
264554c0a3aSHans de Goede #endif /* DBG_CH_SWITCH */
265554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
266554c0a3aSHans de Goede
267554c0a3aSHans de Goede if (dvobj->oper_channel != ch) {
268554c0a3aSHans de Goede dvobj->on_oper_ch_time = jiffies;
269554c0a3aSHans de Goede
270554c0a3aSHans de Goede #ifdef DBG_CH_SWITCH
271038341dcSTakashi Iwai cnt += scnprintf(msg+cnt, len-cnt, "switch to ch %3u", ch);
272554c0a3aSHans de Goede
273554c0a3aSHans de Goede for (i = 0; i < dvobj->iface_nums; i++) {
274554c0a3aSHans de Goede struct adapter *iface = dvobj->padapters[i];
27522045712SRoss Schmidt
276d0cc39cdSRoss Schmidt cnt += scnprintf(msg+cnt, len-cnt, " [%s:", ADPT_ARG(iface));
277554c0a3aSHans de Goede if (iface->mlmeextpriv.cur_channel == ch)
278038341dcSTakashi Iwai cnt += scnprintf(msg+cnt, len-cnt, "C");
279554c0a3aSHans de Goede else
280038341dcSTakashi Iwai cnt += scnprintf(msg+cnt, len-cnt, "_");
281554c0a3aSHans de Goede if (iface->wdinfo.listen_channel == ch && !rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_NONE))
282038341dcSTakashi Iwai cnt += scnprintf(msg+cnt, len-cnt, "L");
283554c0a3aSHans de Goede else
284038341dcSTakashi Iwai cnt += scnprintf(msg+cnt, len-cnt, "_");
285038341dcSTakashi Iwai cnt += scnprintf(msg+cnt, len-cnt, "]");
286554c0a3aSHans de Goede }
287554c0a3aSHans de Goede
288554c0a3aSHans de Goede #endif /* DBG_CH_SWITCH */
289554c0a3aSHans de Goede }
290554c0a3aSHans de Goede
291554c0a3aSHans de Goede dvobj->oper_channel = ch;
292554c0a3aSHans de Goede }
293554c0a3aSHans de Goede
rtw_get_oper_bw(struct adapter * adapter)294554c0a3aSHans de Goede inline u8 rtw_get_oper_bw(struct adapter *adapter)
295554c0a3aSHans de Goede {
296554c0a3aSHans de Goede return adapter_to_dvobj(adapter)->oper_bwmode;
297554c0a3aSHans de Goede }
298554c0a3aSHans de Goede
rtw_set_oper_bw(struct adapter * adapter,u8 bw)299554c0a3aSHans de Goede inline void rtw_set_oper_bw(struct adapter *adapter, u8 bw)
300554c0a3aSHans de Goede {
301554c0a3aSHans de Goede adapter_to_dvobj(adapter)->oper_bwmode = bw;
302554c0a3aSHans de Goede }
303554c0a3aSHans de Goede
rtw_get_oper_choffset(struct adapter * adapter)304554c0a3aSHans de Goede inline u8 rtw_get_oper_choffset(struct adapter *adapter)
305554c0a3aSHans de Goede {
306554c0a3aSHans de Goede return adapter_to_dvobj(adapter)->oper_ch_offset;
307554c0a3aSHans de Goede }
308554c0a3aSHans de Goede
rtw_set_oper_choffset(struct adapter * adapter,u8 offset)309554c0a3aSHans de Goede inline void rtw_set_oper_choffset(struct adapter *adapter, u8 offset)
310554c0a3aSHans de Goede {
311554c0a3aSHans de Goede adapter_to_dvobj(adapter)->oper_ch_offset = offset;
312554c0a3aSHans de Goede }
313554c0a3aSHans de Goede
rtw_get_center_ch(u8 channel,u8 chnl_bw,u8 chnl_offset)314554c0a3aSHans de Goede u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset)
315554c0a3aSHans de Goede {
316554c0a3aSHans de Goede u8 center_ch = channel;
317554c0a3aSHans de Goede
31833137187SFabio Aiuto if (chnl_bw == CHANNEL_WIDTH_40) {
319554c0a3aSHans de Goede if (chnl_offset == HAL_PRIME_CHNL_OFFSET_LOWER)
320554c0a3aSHans de Goede center_ch = channel + 2;
321554c0a3aSHans de Goede else
322554c0a3aSHans de Goede center_ch = channel - 2;
323554c0a3aSHans de Goede }
324554c0a3aSHans de Goede
325554c0a3aSHans de Goede return center_ch;
326554c0a3aSHans de Goede }
327554c0a3aSHans de Goede
rtw_get_on_cur_ch_time(struct adapter * adapter)328554c0a3aSHans de Goede inline unsigned long rtw_get_on_cur_ch_time(struct adapter *adapter)
329554c0a3aSHans de Goede {
330554c0a3aSHans de Goede if (adapter->mlmeextpriv.cur_channel == adapter_to_dvobj(adapter)->oper_channel)
331554c0a3aSHans de Goede return adapter_to_dvobj(adapter)->on_oper_ch_time;
332554c0a3aSHans de Goede else
333554c0a3aSHans de Goede return 0;
334554c0a3aSHans de Goede }
335554c0a3aSHans de Goede
SelectChannel(struct adapter * padapter,unsigned char channel)336554c0a3aSHans de Goede void SelectChannel(struct adapter *padapter, unsigned char channel)
337554c0a3aSHans de Goede {
338554c0a3aSHans de Goede if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->setch_mutex)))
339554c0a3aSHans de Goede return;
340554c0a3aSHans de Goede
341554c0a3aSHans de Goede /* saved channel info */
342554c0a3aSHans de Goede rtw_set_oper_ch(padapter, channel);
343554c0a3aSHans de Goede
344554c0a3aSHans de Goede rtw_hal_set_chan(padapter, channel);
345554c0a3aSHans de Goede
346554c0a3aSHans de Goede mutex_unlock(&(adapter_to_dvobj(padapter)->setch_mutex));
347554c0a3aSHans de Goede }
348554c0a3aSHans de Goede
set_channel_bwmode(struct adapter * padapter,unsigned char channel,unsigned char channel_offset,unsigned short bwmode)349554c0a3aSHans de Goede void set_channel_bwmode(struct adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode)
350554c0a3aSHans de Goede {
351554c0a3aSHans de Goede u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
352554c0a3aSHans de Goede
353554c0a3aSHans de Goede center_ch = rtw_get_center_ch(channel, bwmode, channel_offset);
354554c0a3aSHans de Goede
355554c0a3aSHans de Goede
356554c0a3aSHans de Goede /* set Channel */
357554c0a3aSHans de Goede if (mutex_lock_interruptible(&(adapter_to_dvobj(padapter)->setch_mutex)))
358554c0a3aSHans de Goede return;
359554c0a3aSHans de Goede
360554c0a3aSHans de Goede /* saved channel/bw info */
361554c0a3aSHans de Goede rtw_set_oper_ch(padapter, channel);
362554c0a3aSHans de Goede rtw_set_oper_bw(padapter, bwmode);
363554c0a3aSHans de Goede rtw_set_oper_choffset(padapter, channel_offset);
364554c0a3aSHans de Goede
365554c0a3aSHans de Goede rtw_hal_set_chnl_bw(padapter, center_ch, bwmode, channel_offset, chnl_offset80); /* set center channel */
366554c0a3aSHans de Goede
367554c0a3aSHans de Goede mutex_unlock(&(adapter_to_dvobj(padapter)->setch_mutex));
368554c0a3aSHans de Goede }
369554c0a3aSHans de Goede
get_my_bssid(struct wlan_bssid_ex * pnetwork)3704a397521SRasmus Villemoes inline u8 *get_my_bssid(struct wlan_bssid_ex *pnetwork)
371554c0a3aSHans de Goede {
372d3fcee1bSFabio Aiuto return pnetwork->mac_address;
373554c0a3aSHans de Goede }
374554c0a3aSHans de Goede
get_beacon_interval(struct wlan_bssid_ex * bss)375554c0a3aSHans de Goede u16 get_beacon_interval(struct wlan_bssid_ex *bss)
376554c0a3aSHans de Goede {
377554c0a3aSHans de Goede __le16 val;
37822045712SRoss Schmidt
379d3fcee1bSFabio Aiuto memcpy((unsigned char *)&val, rtw_get_beacon_interval_from_ie(bss->ies), 2);
380554c0a3aSHans de Goede
381554c0a3aSHans de Goede return le16_to_cpu(val);
382554c0a3aSHans de Goede }
383554c0a3aSHans de Goede
is_client_associated_to_ap(struct adapter * padapter)384554c0a3aSHans de Goede int is_client_associated_to_ap(struct adapter *padapter)
385554c0a3aSHans de Goede {
386554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext;
387554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo;
388554c0a3aSHans de Goede
389554c0a3aSHans de Goede if (!padapter)
390554c0a3aSHans de Goede return _FAIL;
391554c0a3aSHans de Goede
392554c0a3aSHans de Goede pmlmeext = &padapter->mlmeextpriv;
393554c0a3aSHans de Goede pmlmeinfo = &(pmlmeext->mlmext_info);
394554c0a3aSHans de Goede
395554c0a3aSHans de Goede if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_STATION_STATE))
396554c0a3aSHans de Goede return true;
397554c0a3aSHans de Goede else
398554c0a3aSHans de Goede return _FAIL;
399554c0a3aSHans de Goede }
400554c0a3aSHans de Goede
is_client_associated_to_ibss(struct adapter * padapter)401554c0a3aSHans de Goede int is_client_associated_to_ibss(struct adapter *padapter)
402554c0a3aSHans de Goede {
403554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
404554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
405554c0a3aSHans de Goede
406554c0a3aSHans de Goede if ((pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) && ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE))
407554c0a3aSHans de Goede return true;
408554c0a3aSHans de Goede else
409554c0a3aSHans de Goede return _FAIL;
410554c0a3aSHans de Goede }
411554c0a3aSHans de Goede
is_IBSS_empty(struct adapter * padapter)412554c0a3aSHans de Goede int is_IBSS_empty(struct adapter *padapter)
413554c0a3aSHans de Goede {
414554c0a3aSHans de Goede unsigned int i;
415554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
416554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
417554c0a3aSHans de Goede
418554c0a3aSHans de Goede for (i = IBSS_START_MAC_ID; i < NUM_STA; i++) {
419554c0a3aSHans de Goede if (pmlmeinfo->FW_sta_info[i].status == 1)
420554c0a3aSHans de Goede return _FAIL;
421554c0a3aSHans de Goede }
422554c0a3aSHans de Goede
423554c0a3aSHans de Goede return true;
424554c0a3aSHans de Goede }
425554c0a3aSHans de Goede
decide_wait_for_beacon_timeout(unsigned int bcn_interval)426554c0a3aSHans de Goede unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval)
427554c0a3aSHans de Goede {
428554c0a3aSHans de Goede if ((bcn_interval << 2) < WAIT_FOR_BCN_TO_MIN)
429554c0a3aSHans de Goede return WAIT_FOR_BCN_TO_MIN;
430554c0a3aSHans de Goede else if ((bcn_interval << 2) > WAIT_FOR_BCN_TO_MAX)
431554c0a3aSHans de Goede return WAIT_FOR_BCN_TO_MAX;
432554c0a3aSHans de Goede else
43341604797SVatsala Narang return bcn_interval << 2;
434554c0a3aSHans de Goede }
435554c0a3aSHans de Goede
invalidate_cam_all(struct adapter * padapter)436554c0a3aSHans de Goede void invalidate_cam_all(struct adapter *padapter)
437554c0a3aSHans de Goede {
438554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(padapter);
439554c0a3aSHans de Goede struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl;
440554c0a3aSHans de Goede
441554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_CAM_INVALID_ALL, NULL);
442554c0a3aSHans de Goede
443554c0a3aSHans de Goede spin_lock_bh(&cam_ctl->lock);
444554c0a3aSHans de Goede cam_ctl->bitmap = 0;
445554c0a3aSHans de Goede memset(dvobj->cam_cache, 0, sizeof(struct cam_entry_cache)*TOTAL_CAM_ENTRY);
446554c0a3aSHans de Goede spin_unlock_bh(&cam_ctl->lock);
447554c0a3aSHans de Goede }
448554c0a3aSHans de Goede
_ReadCAM(struct adapter * padapter,u32 addr)449554c0a3aSHans de Goede static u32 _ReadCAM(struct adapter *padapter, u32 addr)
450554c0a3aSHans de Goede {
451554c0a3aSHans de Goede u32 count = 0, cmd;
45222045712SRoss Schmidt
453554c0a3aSHans de Goede cmd = CAM_POLLINIG | addr;
454554c0a3aSHans de Goede rtw_write32(padapter, RWCAM, cmd);
455554c0a3aSHans de Goede
456554c0a3aSHans de Goede do {
457554c0a3aSHans de Goede if (0 == (rtw_read32(padapter, REG_CAMCMD) & CAM_POLLINIG))
458554c0a3aSHans de Goede break;
459554c0a3aSHans de Goede } while (count++ < 100);
460554c0a3aSHans de Goede
461554c0a3aSHans de Goede return rtw_read32(padapter, REG_CAMREAD);
462554c0a3aSHans de Goede }
46322045712SRoss Schmidt
read_cam(struct adapter * padapter,u8 entry,u8 * get_key)464554c0a3aSHans de Goede void read_cam(struct adapter *padapter, u8 entry, u8 *get_key)
465554c0a3aSHans de Goede {
466554c0a3aSHans de Goede u32 j, addr, cmd;
46722045712SRoss Schmidt
468554c0a3aSHans de Goede addr = entry << 3;
469554c0a3aSHans de Goede
470554c0a3aSHans de Goede for (j = 0; j < 6; j++) {
471554c0a3aSHans de Goede cmd = _ReadCAM(padapter, addr+j);
472554c0a3aSHans de Goede if (j > 1) /* get key from cam */
473554c0a3aSHans de Goede memcpy(get_key+(j-2)*4, &cmd, 4);
474554c0a3aSHans de Goede }
475554c0a3aSHans de Goede }
476554c0a3aSHans de Goede
_write_cam(struct adapter * padapter,u8 entry,u16 ctrl,u8 * mac,u8 * key)477554c0a3aSHans de Goede void _write_cam(struct adapter *padapter, u8 entry, u16 ctrl, u8 *mac, u8 *key)
478554c0a3aSHans de Goede {
479554c0a3aSHans de Goede unsigned int i, val, addr;
480554c0a3aSHans de Goede int j;
481554c0a3aSHans de Goede u32 cam_val[2];
482554c0a3aSHans de Goede
483554c0a3aSHans de Goede addr = entry << 3;
484554c0a3aSHans de Goede
485554c0a3aSHans de Goede for (j = 5; j >= 0; j--) {
486554c0a3aSHans de Goede switch (j) {
487554c0a3aSHans de Goede case 0:
488554c0a3aSHans de Goede val = (ctrl | (mac[0] << 16) | (mac[1] << 24));
489554c0a3aSHans de Goede break;
490554c0a3aSHans de Goede case 1:
491554c0a3aSHans de Goede val = (mac[2] | (mac[3] << 8) | (mac[4] << 16) | (mac[5] << 24));
492554c0a3aSHans de Goede break;
493554c0a3aSHans de Goede default:
494554c0a3aSHans de Goede i = (j - 2) << 2;
495554c0a3aSHans de Goede val = (key[i] | (key[i+1] << 8) | (key[i+2] << 16) | (key[i+3] << 24));
496554c0a3aSHans de Goede break;
497554c0a3aSHans de Goede }
498554c0a3aSHans de Goede
499554c0a3aSHans de Goede cam_val[0] = val;
500554c0a3aSHans de Goede cam_val[1] = addr + (unsigned int)j;
501554c0a3aSHans de Goede
502554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_CAM_WRITE, (u8 *)cam_val);
503554c0a3aSHans de Goede }
504554c0a3aSHans de Goede }
505554c0a3aSHans de Goede
_clear_cam_entry(struct adapter * padapter,u8 entry)506554c0a3aSHans de Goede void _clear_cam_entry(struct adapter *padapter, u8 entry)
507554c0a3aSHans de Goede {
508554c0a3aSHans de Goede unsigned char null_sta[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
509554c0a3aSHans de Goede unsigned char null_key[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
510554c0a3aSHans de Goede
511554c0a3aSHans de Goede _write_cam(padapter, entry, 0, null_sta, null_key);
512554c0a3aSHans de Goede }
513554c0a3aSHans de Goede
write_cam(struct adapter * adapter,u8 id,u16 ctrl,u8 * mac,u8 * key)514554c0a3aSHans de Goede inline void write_cam(struct adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key)
515554c0a3aSHans de Goede {
516554c0a3aSHans de Goede _write_cam(adapter, id, ctrl, mac, key);
517554c0a3aSHans de Goede write_cam_cache(adapter, id, ctrl, mac, key);
518554c0a3aSHans de Goede }
519554c0a3aSHans de Goede
clear_cam_entry(struct adapter * adapter,u8 id)520554c0a3aSHans de Goede inline void clear_cam_entry(struct adapter *adapter, u8 id)
521554c0a3aSHans de Goede {
522554c0a3aSHans de Goede _clear_cam_entry(adapter, id);
523554c0a3aSHans de Goede clear_cam_cache(adapter, id);
524554c0a3aSHans de Goede }
525554c0a3aSHans de Goede
write_cam_cache(struct adapter * adapter,u8 id,u16 ctrl,u8 * mac,u8 * key)526554c0a3aSHans de Goede void write_cam_cache(struct adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key)
527554c0a3aSHans de Goede {
528554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
529554c0a3aSHans de Goede struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl;
530554c0a3aSHans de Goede
531554c0a3aSHans de Goede spin_lock_bh(&cam_ctl->lock);
532554c0a3aSHans de Goede
533554c0a3aSHans de Goede dvobj->cam_cache[id].ctrl = ctrl;
534554c0a3aSHans de Goede memcpy(dvobj->cam_cache[id].mac, mac, ETH_ALEN);
535554c0a3aSHans de Goede memcpy(dvobj->cam_cache[id].key, key, 16);
536554c0a3aSHans de Goede
537554c0a3aSHans de Goede spin_unlock_bh(&cam_ctl->lock);
538554c0a3aSHans de Goede }
539554c0a3aSHans de Goede
clear_cam_cache(struct adapter * adapter,u8 id)540554c0a3aSHans de Goede void clear_cam_cache(struct adapter *adapter, u8 id)
541554c0a3aSHans de Goede {
542554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
543554c0a3aSHans de Goede struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl;
544554c0a3aSHans de Goede
545554c0a3aSHans de Goede spin_lock_bh(&cam_ctl->lock);
546554c0a3aSHans de Goede
547554c0a3aSHans de Goede memset(&(dvobj->cam_cache[id]), 0, sizeof(struct cam_entry_cache));
548554c0a3aSHans de Goede
549554c0a3aSHans de Goede spin_unlock_bh(&cam_ctl->lock);
550554c0a3aSHans de Goede }
551554c0a3aSHans de Goede
_rtw_camid_is_gk(struct adapter * adapter,u8 cam_id)552554c0a3aSHans de Goede static bool _rtw_camid_is_gk(struct adapter *adapter, u8 cam_id)
553554c0a3aSHans de Goede {
554554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
555554c0a3aSHans de Goede struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl;
556554c0a3aSHans de Goede bool ret = false;
557554c0a3aSHans de Goede
558554c0a3aSHans de Goede if (cam_id >= TOTAL_CAM_ENTRY)
559554c0a3aSHans de Goede goto exit;
560554c0a3aSHans de Goede
561554c0a3aSHans de Goede if (!(cam_ctl->bitmap & BIT(cam_id)))
562554c0a3aSHans de Goede goto exit;
563554c0a3aSHans de Goede
564554c0a3aSHans de Goede ret = (dvobj->cam_cache[cam_id].ctrl&BIT6)?true:false;
565554c0a3aSHans de Goede
566554c0a3aSHans de Goede exit:
567554c0a3aSHans de Goede return ret;
568554c0a3aSHans de Goede }
569554c0a3aSHans de Goede
_rtw_camid_search(struct adapter * adapter,u8 * addr,s16 kid)570554c0a3aSHans de Goede static s16 _rtw_camid_search(struct adapter *adapter, u8 *addr, s16 kid)
571554c0a3aSHans de Goede {
572554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
573554c0a3aSHans de Goede int i;
574554c0a3aSHans de Goede s16 cam_id = -1;
575554c0a3aSHans de Goede
576554c0a3aSHans de Goede for (i = 0; i < TOTAL_CAM_ENTRY; i++) {
577554c0a3aSHans de Goede if (addr && memcmp(dvobj->cam_cache[i].mac, addr, ETH_ALEN))
578554c0a3aSHans de Goede continue;
579554c0a3aSHans de Goede if (kid >= 0 && kid != (dvobj->cam_cache[i].ctrl&0x03))
580554c0a3aSHans de Goede continue;
581554c0a3aSHans de Goede
582554c0a3aSHans de Goede cam_id = i;
583554c0a3aSHans de Goede break;
584554c0a3aSHans de Goede }
585554c0a3aSHans de Goede
586554c0a3aSHans de Goede return cam_id;
587554c0a3aSHans de Goede }
588554c0a3aSHans de Goede
rtw_camid_search(struct adapter * adapter,u8 * addr,s16 kid)589554c0a3aSHans de Goede s16 rtw_camid_search(struct adapter *adapter, u8 *addr, s16 kid)
590554c0a3aSHans de Goede {
591554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
592554c0a3aSHans de Goede struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl;
593554c0a3aSHans de Goede s16 cam_id = -1;
594554c0a3aSHans de Goede
595554c0a3aSHans de Goede spin_lock_bh(&cam_ctl->lock);
596554c0a3aSHans de Goede cam_id = _rtw_camid_search(adapter, addr, kid);
597554c0a3aSHans de Goede spin_unlock_bh(&cam_ctl->lock);
598554c0a3aSHans de Goede
599554c0a3aSHans de Goede return cam_id;
600554c0a3aSHans de Goede }
601554c0a3aSHans de Goede
rtw_camid_alloc(struct adapter * adapter,struct sta_info * sta,u8 kid)602554c0a3aSHans de Goede s16 rtw_camid_alloc(struct adapter *adapter, struct sta_info *sta, u8 kid)
603554c0a3aSHans de Goede {
604554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
605554c0a3aSHans de Goede struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl;
606554c0a3aSHans de Goede s16 cam_id = -1;
607554c0a3aSHans de Goede struct mlme_ext_info *mlmeinfo;
608554c0a3aSHans de Goede
609554c0a3aSHans de Goede spin_lock_bh(&cam_ctl->lock);
610554c0a3aSHans de Goede
611554c0a3aSHans de Goede mlmeinfo = &adapter->mlmeextpriv.mlmext_info;
612554c0a3aSHans de Goede
613554c0a3aSHans de Goede if ((((mlmeinfo->state&0x03) == WIFI_FW_AP_STATE) || ((mlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE))
614554c0a3aSHans de Goede && !sta) {
615554c0a3aSHans de Goede /* AP/Ad-hoc mode group key: static alloction to default key by key ID */
616554c0a3aSHans de Goede if (kid > 3) {
61779df841bSFabio Aiuto netdev_dbg(adapter->pnetdev,
61879df841bSFabio Aiuto FUNC_ADPT_FMT " group key with invalid key id:%u\n",
61979df841bSFabio Aiuto FUNC_ADPT_ARG(adapter), kid);
620554c0a3aSHans de Goede rtw_warn_on(1);
621554c0a3aSHans de Goede goto bitmap_handle;
622554c0a3aSHans de Goede }
623554c0a3aSHans de Goede
624554c0a3aSHans de Goede cam_id = kid;
625554c0a3aSHans de Goede } else {
626554c0a3aSHans de Goede int i;
627554c0a3aSHans de Goede u8 *addr = sta?sta->hwaddr:NULL;
628554c0a3aSHans de Goede
629554c0a3aSHans de Goede if (!sta) {
630554c0a3aSHans de Goede if (!(mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) {
631554c0a3aSHans de Goede /* bypass STA mode group key setting before connected(ex:WEP) because bssid is not ready */
632554c0a3aSHans de Goede goto bitmap_handle;
633554c0a3aSHans de Goede }
634554c0a3aSHans de Goede
635554c0a3aSHans de Goede addr = get_bssid(&adapter->mlmepriv);
636554c0a3aSHans de Goede }
637554c0a3aSHans de Goede
638554c0a3aSHans de Goede i = _rtw_camid_search(adapter, addr, kid);
639554c0a3aSHans de Goede if (i >= 0) {
640554c0a3aSHans de Goede /* Fix issue that pairwise and group key have same key id. Pairwise key first, group key can overwirte group only(ex: rekey) */
64163a9c3edSJeeeun Evans if (sta || _rtw_camid_is_gk(adapter, i))
642554c0a3aSHans de Goede cam_id = i;
643554c0a3aSHans de Goede else
64479df841bSFabio Aiuto netdev_dbg(adapter->pnetdev,
64579df841bSFabio Aiuto FUNC_ADPT_FMT " group key id:%u the same key id as pairwise key\n",
64679df841bSFabio Aiuto FUNC_ADPT_ARG(adapter), kid);
647554c0a3aSHans de Goede goto bitmap_handle;
648554c0a3aSHans de Goede }
649554c0a3aSHans de Goede
650554c0a3aSHans de Goede for (i = 4; i < TOTAL_CAM_ENTRY; i++)
651554c0a3aSHans de Goede if (!(cam_ctl->bitmap & BIT(i)))
652554c0a3aSHans de Goede break;
653554c0a3aSHans de Goede
654554c0a3aSHans de Goede if (i == TOTAL_CAM_ENTRY) {
655554c0a3aSHans de Goede if (sta)
65679df841bSFabio Aiuto netdev_dbg(adapter->pnetdev,
65779df841bSFabio Aiuto FUNC_ADPT_FMT " pairwise key with %pM id:%u no room\n",
65879df841bSFabio Aiuto FUNC_ADPT_ARG(adapter),
65979df841bSFabio Aiuto MAC_ARG(sta->hwaddr), kid);
660554c0a3aSHans de Goede else
66179df841bSFabio Aiuto netdev_dbg(adapter->pnetdev,
66279df841bSFabio Aiuto FUNC_ADPT_FMT " group key id:%u no room\n",
66379df841bSFabio Aiuto FUNC_ADPT_ARG(adapter), kid);
664554c0a3aSHans de Goede rtw_warn_on(1);
665554c0a3aSHans de Goede goto bitmap_handle;
666554c0a3aSHans de Goede }
667554c0a3aSHans de Goede
668554c0a3aSHans de Goede cam_id = i;
669554c0a3aSHans de Goede }
670554c0a3aSHans de Goede
671554c0a3aSHans de Goede bitmap_handle:
672130cf72fSLarry Finger if (cam_id >= 0 && cam_id < 32)
673554c0a3aSHans de Goede cam_ctl->bitmap |= BIT(cam_id);
674554c0a3aSHans de Goede
675554c0a3aSHans de Goede spin_unlock_bh(&cam_ctl->lock);
676554c0a3aSHans de Goede
677554c0a3aSHans de Goede return cam_id;
678554c0a3aSHans de Goede }
679554c0a3aSHans de Goede
rtw_camid_free(struct adapter * adapter,u8 cam_id)680554c0a3aSHans de Goede void rtw_camid_free(struct adapter *adapter, u8 cam_id)
681554c0a3aSHans de Goede {
682554c0a3aSHans de Goede struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
683554c0a3aSHans de Goede struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl;
684554c0a3aSHans de Goede
685554c0a3aSHans de Goede spin_lock_bh(&cam_ctl->lock);
686554c0a3aSHans de Goede
687554c0a3aSHans de Goede if (cam_id < TOTAL_CAM_ENTRY)
688554c0a3aSHans de Goede cam_ctl->bitmap &= ~(BIT(cam_id));
689554c0a3aSHans de Goede
690554c0a3aSHans de Goede spin_unlock_bh(&cam_ctl->lock);
691554c0a3aSHans de Goede }
692554c0a3aSHans de Goede
allocate_fw_sta_entry(struct adapter * padapter)693554c0a3aSHans de Goede int allocate_fw_sta_entry(struct adapter *padapter)
694554c0a3aSHans de Goede {
695554c0a3aSHans de Goede unsigned int mac_id;
696554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
697554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
698554c0a3aSHans de Goede
699554c0a3aSHans de Goede for (mac_id = IBSS_START_MAC_ID; mac_id < NUM_STA; mac_id++) {
700554c0a3aSHans de Goede if (pmlmeinfo->FW_sta_info[mac_id].status == 0) {
701554c0a3aSHans de Goede pmlmeinfo->FW_sta_info[mac_id].status = 1;
702554c0a3aSHans de Goede pmlmeinfo->FW_sta_info[mac_id].retry = 0;
703554c0a3aSHans de Goede break;
704554c0a3aSHans de Goede }
705554c0a3aSHans de Goede }
706554c0a3aSHans de Goede
707554c0a3aSHans de Goede return mac_id;
708554c0a3aSHans de Goede }
709554c0a3aSHans de Goede
flush_all_cam_entry(struct adapter * padapter)710554c0a3aSHans de Goede void flush_all_cam_entry(struct adapter *padapter)
711554c0a3aSHans de Goede {
712554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
713554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
714554c0a3aSHans de Goede
715554c0a3aSHans de Goede invalidate_cam_all(padapter);
716554c0a3aSHans de Goede /* clear default key related key search setting */
717554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_SEC_DK_CFG, (u8 *)false);
718554c0a3aSHans de Goede
719554c0a3aSHans de Goede memset((u8 *)(pmlmeinfo->FW_sta_info), 0, sizeof(pmlmeinfo->FW_sta_info));
720554c0a3aSHans de Goede }
721554c0a3aSHans de Goede
WMM_param_handler(struct adapter * padapter,struct ndis_80211_var_ie * pIE)722554c0a3aSHans de Goede int WMM_param_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE)
723554c0a3aSHans de Goede {
724554c0a3aSHans de Goede /* struct registry_priv *pregpriv = &padapter->registrypriv; */
725554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
726554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
727554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
728554c0a3aSHans de Goede
729554c0a3aSHans de Goede if (pmlmepriv->qospriv.qos_option == 0) {
730554c0a3aSHans de Goede pmlmeinfo->WMM_enable = 0;
731554c0a3aSHans de Goede return false;
732554c0a3aSHans de Goede }
733554c0a3aSHans de Goede
734554c0a3aSHans de Goede if (!memcmp(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element)))
735554c0a3aSHans de Goede return false;
736554c0a3aSHans de Goede else
737554c0a3aSHans de Goede memcpy(&(pmlmeinfo->WMM_param), (pIE->data + 6), sizeof(struct WMM_para_element));
738554c0a3aSHans de Goede
739554c0a3aSHans de Goede pmlmeinfo->WMM_enable = 1;
740554c0a3aSHans de Goede return true;
741554c0a3aSHans de Goede }
742554c0a3aSHans de Goede
sort_wmm_ac_params(u32 * inx,u32 * edca)7433c8c577fSShreyansh Chouhan static void sort_wmm_ac_params(u32 *inx, u32 *edca)
7443c8c577fSShreyansh Chouhan {
7453c8c577fSShreyansh Chouhan u32 i, j, change_inx = false;
7463c8c577fSShreyansh Chouhan
7473c8c577fSShreyansh Chouhan /* entry indx: 0->vo, 1->vi, 2->be, 3->bk. */
7483c8c577fSShreyansh Chouhan for (i = 0; i < 4; i++) {
7493c8c577fSShreyansh Chouhan for (j = i + 1; j < 4; j++) {
7503c8c577fSShreyansh Chouhan /* compare CW and AIFS */
7513c8c577fSShreyansh Chouhan if ((edca[j] & 0xFFFF) < (edca[i] & 0xFFFF)) {
7523c8c577fSShreyansh Chouhan change_inx = true;
7533c8c577fSShreyansh Chouhan } else if ((edca[j] & 0xFFFF) == (edca[i] & 0xFFFF)) {
7543c8c577fSShreyansh Chouhan /* compare TXOP */
7553c8c577fSShreyansh Chouhan if ((edca[j] >> 16) > (edca[i] >> 16))
7563c8c577fSShreyansh Chouhan change_inx = true;
7573c8c577fSShreyansh Chouhan }
7583c8c577fSShreyansh Chouhan
7593c8c577fSShreyansh Chouhan if (change_inx) {
7603c8c577fSShreyansh Chouhan swap(edca[i], edca[j]);
7613c8c577fSShreyansh Chouhan swap(inx[i], inx[j]);
7623c8c577fSShreyansh Chouhan
7633c8c577fSShreyansh Chouhan change_inx = false;
7643c8c577fSShreyansh Chouhan }
7653c8c577fSShreyansh Chouhan }
7663c8c577fSShreyansh Chouhan }
7673c8c577fSShreyansh Chouhan }
7683c8c577fSShreyansh Chouhan
WMMOnAssocRsp(struct adapter * padapter)769554c0a3aSHans de Goede void WMMOnAssocRsp(struct adapter *padapter)
770554c0a3aSHans de Goede {
771554c0a3aSHans de Goede u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime;
772554c0a3aSHans de Goede u8 acm_mask;
773554c0a3aSHans de Goede u16 TXOP;
774554c0a3aSHans de Goede u32 acParm, i;
775554c0a3aSHans de Goede u32 edca[4], inx[4];
776554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
777554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
778554c0a3aSHans de Goede struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
779554c0a3aSHans de Goede struct registry_priv *pregpriv = &padapter->registrypriv;
780554c0a3aSHans de Goede
781554c0a3aSHans de Goede acm_mask = 0;
782554c0a3aSHans de Goede
783554c0a3aSHans de Goede if (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)
784554c0a3aSHans de Goede aSifsTime = 16;
785554c0a3aSHans de Goede else
786554c0a3aSHans de Goede aSifsTime = 10;
787554c0a3aSHans de Goede
788554c0a3aSHans de Goede if (pmlmeinfo->WMM_enable == 0) {
789554c0a3aSHans de Goede padapter->mlmepriv.acm_mask = 0;
790554c0a3aSHans de Goede
791554c0a3aSHans de Goede AIFS = aSifsTime + (2 * pmlmeinfo->slotTime);
792554c0a3aSHans de Goede
793708180a9SFabio Aiuto if (pmlmeext->cur_wireless_mode & WIRELESS_11G) {
794554c0a3aSHans de Goede ECWMin = 4;
795554c0a3aSHans de Goede ECWMax = 10;
796554c0a3aSHans de Goede } else if (pmlmeext->cur_wireless_mode & WIRELESS_11B) {
797554c0a3aSHans de Goede ECWMin = 5;
798554c0a3aSHans de Goede ECWMax = 10;
799554c0a3aSHans de Goede } else {
800554c0a3aSHans de Goede ECWMin = 4;
801554c0a3aSHans de Goede ECWMax = 10;
802554c0a3aSHans de Goede }
803554c0a3aSHans de Goede
804554c0a3aSHans de Goede TXOP = 0;
805554c0a3aSHans de Goede acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16);
806554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm));
807554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm));
808554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm));
809554c0a3aSHans de Goede
810554c0a3aSHans de Goede ECWMin = 2;
811554c0a3aSHans de Goede ECWMax = 3;
812554c0a3aSHans de Goede TXOP = 0x2f;
813554c0a3aSHans de Goede acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16);
814554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm));
815554c0a3aSHans de Goede } else {
816554c0a3aSHans de Goede edca[0] = edca[1] = edca[2] = edca[3] = 0;
817554c0a3aSHans de Goede
818554c0a3aSHans de Goede for (i = 0; i < 4; i++) {
819554c0a3aSHans de Goede ACI = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 5) & 0x03;
820554c0a3aSHans de Goede ACM = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN >> 4) & 0x01;
821554c0a3aSHans de Goede
822554c0a3aSHans de Goede /* AIFS = AIFSN * slot time + SIFS - r2t phy delay */
823554c0a3aSHans de Goede AIFS = (pmlmeinfo->WMM_param.ac_param[i].ACI_AIFSN & 0x0f) * pmlmeinfo->slotTime + aSifsTime;
824554c0a3aSHans de Goede
825554c0a3aSHans de Goede ECWMin = (pmlmeinfo->WMM_param.ac_param[i].CW & 0x0f);
826554c0a3aSHans de Goede ECWMax = (pmlmeinfo->WMM_param.ac_param[i].CW & 0xf0) >> 4;
827554c0a3aSHans de Goede TXOP = le16_to_cpu(pmlmeinfo->WMM_param.ac_param[i].TXOP_limit);
828554c0a3aSHans de Goede
829554c0a3aSHans de Goede acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16);
830554c0a3aSHans de Goede
831554c0a3aSHans de Goede switch (ACI) {
832554c0a3aSHans de Goede case 0x0:
833554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm));
834554c0a3aSHans de Goede acm_mask |= (ACM ? BIT(1):0);
835554c0a3aSHans de Goede edca[XMIT_BE_QUEUE] = acParm;
836554c0a3aSHans de Goede break;
837554c0a3aSHans de Goede
838554c0a3aSHans de Goede case 0x1:
839554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm));
840554c0a3aSHans de Goede /* acm_mask |= (ACM? BIT(0):0); */
841554c0a3aSHans de Goede edca[XMIT_BK_QUEUE] = acParm;
842554c0a3aSHans de Goede break;
843554c0a3aSHans de Goede
844554c0a3aSHans de Goede case 0x2:
845554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm));
846554c0a3aSHans de Goede acm_mask |= (ACM ? BIT(2):0);
847554c0a3aSHans de Goede edca[XMIT_VI_QUEUE] = acParm;
848554c0a3aSHans de Goede break;
849554c0a3aSHans de Goede
850554c0a3aSHans de Goede case 0x3:
851554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm));
852554c0a3aSHans de Goede acm_mask |= (ACM ? BIT(3):0);
853554c0a3aSHans de Goede edca[XMIT_VO_QUEUE] = acParm;
854554c0a3aSHans de Goede break;
855554c0a3aSHans de Goede }
856554c0a3aSHans de Goede }
857554c0a3aSHans de Goede
858554c0a3aSHans de Goede if (padapter->registrypriv.acm_method == 1)
859554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_ACM_CTRL, (u8 *)(&acm_mask));
860554c0a3aSHans de Goede else
861554c0a3aSHans de Goede padapter->mlmepriv.acm_mask = acm_mask;
862554c0a3aSHans de Goede
863554c0a3aSHans de Goede inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3;
864554c0a3aSHans de Goede
8653c8c577fSShreyansh Chouhan if (pregpriv->wifi_spec == 1)
8663c8c577fSShreyansh Chouhan sort_wmm_ac_params(inx, edca);
867554c0a3aSHans de Goede
868709c8e49SFabio Aiuto for (i = 0; i < 4; i++)
869554c0a3aSHans de Goede pxmitpriv->wmm_para_seq[i] = inx[i];
870554c0a3aSHans de Goede }
871554c0a3aSHans de Goede }
872554c0a3aSHans de Goede
bwmode_update_check(struct adapter * padapter,struct ndis_80211_var_ie * pIE)873554c0a3aSHans de Goede static void bwmode_update_check(struct adapter *padapter, struct ndis_80211_var_ie *pIE)
874554c0a3aSHans de Goede {
875554c0a3aSHans de Goede unsigned char new_bwmode;
876554c0a3aSHans de Goede unsigned char new_ch_offset;
877554c0a3aSHans de Goede struct HT_info_element *pHT_info;
878554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
879554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
880554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
881554c0a3aSHans de Goede struct registry_priv *pregistrypriv = &padapter->registrypriv;
882554c0a3aSHans de Goede struct ht_priv *phtpriv = &pmlmepriv->htpriv;
883554c0a3aSHans de Goede u8 cbw40_enable = 0;
884554c0a3aSHans de Goede
885554c0a3aSHans de Goede if (!pIE)
886554c0a3aSHans de Goede return;
887554c0a3aSHans de Goede
888554c0a3aSHans de Goede if (phtpriv->ht_option == false)
889554c0a3aSHans de Goede return;
890554c0a3aSHans de Goede
89161ba4faeSFabio Aiuto if (pIE->length > sizeof(struct HT_info_element))
892554c0a3aSHans de Goede return;
893554c0a3aSHans de Goede
894554c0a3aSHans de Goede pHT_info = (struct HT_info_element *)pIE->data;
895554c0a3aSHans de Goede
896554c0a3aSHans de Goede if (pmlmeext->cur_channel > 14) {
897554c0a3aSHans de Goede if ((pregistrypriv->bw_mode & 0xf0) > 0)
898554c0a3aSHans de Goede cbw40_enable = 1;
89970466c39SRoss Schmidt } else {
900554c0a3aSHans de Goede if ((pregistrypriv->bw_mode & 0x0f) > 0)
901554c0a3aSHans de Goede cbw40_enable = 1;
90270466c39SRoss Schmidt }
903554c0a3aSHans de Goede
904554c0a3aSHans de Goede if ((pHT_info->infos[0] & BIT(2)) && cbw40_enable) {
905554c0a3aSHans de Goede new_bwmode = CHANNEL_WIDTH_40;
906554c0a3aSHans de Goede
907554c0a3aSHans de Goede switch (pHT_info->infos[0] & 0x3) {
908554c0a3aSHans de Goede case 1:
909554c0a3aSHans de Goede new_ch_offset = HAL_PRIME_CHNL_OFFSET_LOWER;
910554c0a3aSHans de Goede break;
911554c0a3aSHans de Goede
912554c0a3aSHans de Goede case 3:
913554c0a3aSHans de Goede new_ch_offset = HAL_PRIME_CHNL_OFFSET_UPPER;
914554c0a3aSHans de Goede break;
915554c0a3aSHans de Goede
916554c0a3aSHans de Goede default:
917554c0a3aSHans de Goede new_bwmode = CHANNEL_WIDTH_20;
918554c0a3aSHans de Goede new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
919554c0a3aSHans de Goede break;
920554c0a3aSHans de Goede }
921554c0a3aSHans de Goede } else {
922554c0a3aSHans de Goede new_bwmode = CHANNEL_WIDTH_20;
923554c0a3aSHans de Goede new_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
924554c0a3aSHans de Goede }
925554c0a3aSHans de Goede
926554c0a3aSHans de Goede if ((new_bwmode != pmlmeext->cur_bwmode) || (new_ch_offset != pmlmeext->cur_ch_offset)) {
927554c0a3aSHans de Goede pmlmeinfo->bwmode_updated = true;
928554c0a3aSHans de Goede
929554c0a3aSHans de Goede pmlmeext->cur_bwmode = new_bwmode;
930554c0a3aSHans de Goede pmlmeext->cur_ch_offset = new_ch_offset;
931554c0a3aSHans de Goede
932554c0a3aSHans de Goede /* update HT info also */
933554c0a3aSHans de Goede HT_info_handler(padapter, pIE);
93470466c39SRoss Schmidt } else {
935554c0a3aSHans de Goede pmlmeinfo->bwmode_updated = false;
93670466c39SRoss Schmidt }
937554c0a3aSHans de Goede
938554c0a3aSHans de Goede if (true == pmlmeinfo->bwmode_updated) {
939554c0a3aSHans de Goede struct sta_info *psta;
940554c0a3aSHans de Goede struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network);
941554c0a3aSHans de Goede struct sta_priv *pstapriv = &padapter->stapriv;
942554c0a3aSHans de Goede
943554c0a3aSHans de Goede /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
944554c0a3aSHans de Goede
945554c0a3aSHans de Goede /* update ap's stainfo */
946d3fcee1bSFabio Aiuto psta = rtw_get_stainfo(pstapriv, cur_network->mac_address);
947554c0a3aSHans de Goede if (psta) {
948554c0a3aSHans de Goede struct ht_priv *phtpriv_sta = &psta->htpriv;
949554c0a3aSHans de Goede
950554c0a3aSHans de Goede if (phtpriv_sta->ht_option) {
951554c0a3aSHans de Goede /* bwmode */
952554c0a3aSHans de Goede psta->bw_mode = pmlmeext->cur_bwmode;
953554c0a3aSHans de Goede phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset;
954554c0a3aSHans de Goede } else {
955554c0a3aSHans de Goede psta->bw_mode = CHANNEL_WIDTH_20;
956554c0a3aSHans de Goede phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
957554c0a3aSHans de Goede }
958554c0a3aSHans de Goede
959554c0a3aSHans de Goede rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta);
960554c0a3aSHans de Goede }
961554c0a3aSHans de Goede }
962554c0a3aSHans de Goede }
963554c0a3aSHans de Goede
HT_caps_handler(struct adapter * padapter,struct ndis_80211_var_ie * pIE)964554c0a3aSHans de Goede void HT_caps_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE)
965554c0a3aSHans de Goede {
966554c0a3aSHans de Goede unsigned int i;
967554c0a3aSHans de Goede u8 max_AMPDU_len, min_MPDU_spacing;
968554c0a3aSHans de Goede u8 cur_ldpc_cap = 0, cur_stbc_cap = 0;
969554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
970554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
971554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
972554c0a3aSHans de Goede struct ht_priv *phtpriv = &pmlmepriv->htpriv;
973554c0a3aSHans de Goede
974c9d19e68SMichael Straube if (!pIE)
975554c0a3aSHans de Goede return;
976554c0a3aSHans de Goede
977554c0a3aSHans de Goede if (phtpriv->ht_option == false)
978554c0a3aSHans de Goede return;
979554c0a3aSHans de Goede
980554c0a3aSHans de Goede pmlmeinfo->HT_caps_enable = 1;
981554c0a3aSHans de Goede
98261ba4faeSFabio Aiuto for (i = 0; i < (pIE->length); i++) {
983554c0a3aSHans de Goede if (i != 2) {
984554c0a3aSHans de Goede /* Commented by Albert 2010/07/12 */
985554c0a3aSHans de Goede /* Got the endian issue here. */
986554c0a3aSHans de Goede pmlmeinfo->HT_caps.u.HT_cap[i] &= (pIE->data[i]);
987554c0a3aSHans de Goede } else {
988554c0a3aSHans de Goede /* modify from fw by Thomas 2010/11/17 */
9896c6ff293SDeepak R Varma max_AMPDU_len = min(pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x3,
9906c6ff293SDeepak R Varma pIE->data[i] & 0x3);
991554c0a3aSHans de Goede
9926c6ff293SDeepak R Varma min_MPDU_spacing = max(pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c,
9936c6ff293SDeepak R Varma pIE->data[i] & 0x1c);
994554c0a3aSHans de Goede
995554c0a3aSHans de Goede pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para = max_AMPDU_len | min_MPDU_spacing;
996554c0a3aSHans de Goede }
997554c0a3aSHans de Goede }
998554c0a3aSHans de Goede
999554c0a3aSHans de Goede /* update the MCS set */
1000554c0a3aSHans de Goede for (i = 0; i < 16; i++)
1001554c0a3aSHans de Goede pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i];
1002554c0a3aSHans de Goede
1003554c0a3aSHans de Goede /* update the MCS rates */
1004554c0a3aSHans de Goede set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R);
1005554c0a3aSHans de Goede
1006554c0a3aSHans de Goede if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) {
1007554c0a3aSHans de Goede /* Config STBC setting */
1008af6afdb6SFabio Aiuto if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) &&
1009af6afdb6SFabio Aiuto GET_HT_CAPABILITY_ELE_TX_STBC(pIE->data))
1010554c0a3aSHans de Goede SET_FLAG(cur_stbc_cap, STBC_HT_ENABLE_TX);
1011709c8e49SFabio Aiuto
1012554c0a3aSHans de Goede phtpriv->stbc_cap = cur_stbc_cap;
1013554c0a3aSHans de Goede } else {
1014554c0a3aSHans de Goede /* Config LDPC Coding Capability */
1015af6afdb6SFabio Aiuto if (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX) &&
1016af6afdb6SFabio Aiuto GET_HT_CAPABILITY_ELE_LDPC_CAP(pIE->data))
1017554c0a3aSHans de Goede SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX));
1018709c8e49SFabio Aiuto
1019554c0a3aSHans de Goede phtpriv->ldpc_cap = cur_ldpc_cap;
1020554c0a3aSHans de Goede
1021554c0a3aSHans de Goede /* Config STBC setting */
1022af6afdb6SFabio Aiuto if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) &&
1023af6afdb6SFabio Aiuto GET_HT_CAPABILITY_ELE_RX_STBC(pIE->data))
1024554c0a3aSHans de Goede SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX));
1025709c8e49SFabio Aiuto
1026554c0a3aSHans de Goede phtpriv->stbc_cap = cur_stbc_cap;
1027554c0a3aSHans de Goede }
1028554c0a3aSHans de Goede }
1029554c0a3aSHans de Goede
HT_info_handler(struct adapter * padapter,struct ndis_80211_var_ie * pIE)1030554c0a3aSHans de Goede void HT_info_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE)
1031554c0a3aSHans de Goede {
1032554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1033554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1034554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
1035554c0a3aSHans de Goede struct ht_priv *phtpriv = &pmlmepriv->htpriv;
1036554c0a3aSHans de Goede
1037c9d19e68SMichael Straube if (!pIE)
1038554c0a3aSHans de Goede return;
1039554c0a3aSHans de Goede
1040554c0a3aSHans de Goede if (phtpriv->ht_option == false)
1041554c0a3aSHans de Goede return;
1042554c0a3aSHans de Goede
104361ba4faeSFabio Aiuto if (pIE->length > sizeof(struct HT_info_element))
1044554c0a3aSHans de Goede return;
1045554c0a3aSHans de Goede
1046554c0a3aSHans de Goede pmlmeinfo->HT_info_enable = 1;
104761ba4faeSFabio Aiuto memcpy(&(pmlmeinfo->HT_info), pIE->data, pIE->length);
1048554c0a3aSHans de Goede }
1049554c0a3aSHans de Goede
HTOnAssocRsp(struct adapter * padapter)1050554c0a3aSHans de Goede void HTOnAssocRsp(struct adapter *padapter)
1051554c0a3aSHans de Goede {
1052554c0a3aSHans de Goede unsigned char max_AMPDU_len;
1053554c0a3aSHans de Goede unsigned char min_MPDU_spacing;
1054554c0a3aSHans de Goede /* struct registry_priv *pregpriv = &padapter->registrypriv; */
1055554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1056554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1057554c0a3aSHans de Goede
1058554c0a3aSHans de Goede if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable)) {
1059554c0a3aSHans de Goede pmlmeinfo->HT_enable = 1;
1060554c0a3aSHans de Goede } else {
1061554c0a3aSHans de Goede pmlmeinfo->HT_enable = 0;
1062554c0a3aSHans de Goede /* set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); */
1063554c0a3aSHans de Goede return;
1064554c0a3aSHans de Goede }
1065554c0a3aSHans de Goede
1066554c0a3aSHans de Goede /* handle A-MPDU parameter field */
1067554c0a3aSHans de Goede /*
1068554c0a3aSHans de Goede AMPDU_para [1:0]:Max AMPDU Len => 0:8k , 1:16k, 2:32k, 3:64k
1069554c0a3aSHans de Goede AMPDU_para [4:2]:Min MPDU Start Spacing
1070554c0a3aSHans de Goede */
1071554c0a3aSHans de Goede max_AMPDU_len = pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x03;
1072554c0a3aSHans de Goede
1073554c0a3aSHans de Goede min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2;
1074554c0a3aSHans de Goede
1075554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing));
1076554c0a3aSHans de Goede
1077554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len));
1078554c0a3aSHans de Goede }
1079554c0a3aSHans de Goede
ERP_IE_handler(struct adapter * padapter,struct ndis_80211_var_ie * pIE)1080554c0a3aSHans de Goede void ERP_IE_handler(struct adapter *padapter, struct ndis_80211_var_ie *pIE)
1081554c0a3aSHans de Goede {
1082554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1083554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1084554c0a3aSHans de Goede
108561ba4faeSFabio Aiuto if (pIE->length > 1)
1086554c0a3aSHans de Goede return;
1087554c0a3aSHans de Goede
1088554c0a3aSHans de Goede pmlmeinfo->ERP_enable = 1;
108961ba4faeSFabio Aiuto memcpy(&(pmlmeinfo->ERP_IE), pIE->data, pIE->length);
1090554c0a3aSHans de Goede }
1091554c0a3aSHans de Goede
VCS_update(struct adapter * padapter,struct sta_info * psta)1092554c0a3aSHans de Goede void VCS_update(struct adapter *padapter, struct sta_info *psta)
1093554c0a3aSHans de Goede {
1094554c0a3aSHans de Goede struct registry_priv *pregpriv = &padapter->registrypriv;
1095554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1096554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1097554c0a3aSHans de Goede
1098554c0a3aSHans de Goede switch (pregpriv->vrtl_carrier_sense) {/* 0:off 1:on 2:auto */
1099554c0a3aSHans de Goede case 0: /* off */
1100554c0a3aSHans de Goede psta->rtsen = 0;
1101554c0a3aSHans de Goede psta->cts2self = 0;
1102554c0a3aSHans de Goede break;
1103554c0a3aSHans de Goede
1104554c0a3aSHans de Goede case 1: /* on */
1105554c0a3aSHans de Goede if (pregpriv->vcs_type == 1) { /* 1:RTS/CTS 2:CTS to self */
1106554c0a3aSHans de Goede psta->rtsen = 1;
1107554c0a3aSHans de Goede psta->cts2self = 0;
1108554c0a3aSHans de Goede } else {
1109554c0a3aSHans de Goede psta->rtsen = 0;
1110554c0a3aSHans de Goede psta->cts2self = 1;
1111554c0a3aSHans de Goede }
1112554c0a3aSHans de Goede break;
1113554c0a3aSHans de Goede
1114554c0a3aSHans de Goede case 2: /* auto */
1115554c0a3aSHans de Goede default:
1116554c0a3aSHans de Goede if ((pmlmeinfo->ERP_enable) && (pmlmeinfo->ERP_IE & BIT(1))) {
1117554c0a3aSHans de Goede if (pregpriv->vcs_type == 1) {
1118554c0a3aSHans de Goede psta->rtsen = 1;
1119554c0a3aSHans de Goede psta->cts2self = 0;
1120554c0a3aSHans de Goede } else {
1121554c0a3aSHans de Goede psta->rtsen = 0;
1122554c0a3aSHans de Goede psta->cts2self = 1;
1123554c0a3aSHans de Goede }
1124554c0a3aSHans de Goede } else {
1125554c0a3aSHans de Goede psta->rtsen = 0;
1126554c0a3aSHans de Goede psta->cts2self = 0;
1127554c0a3aSHans de Goede }
1128554c0a3aSHans de Goede break;
1129554c0a3aSHans de Goede }
1130554c0a3aSHans de Goede }
1131554c0a3aSHans de Goede
update_ldpc_stbc_cap(struct sta_info * psta)1132554c0a3aSHans de Goede void update_ldpc_stbc_cap(struct sta_info *psta)
1133554c0a3aSHans de Goede {
1134554c0a3aSHans de Goede if (psta->htpriv.ht_option) {
1135554c0a3aSHans de Goede if (TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX))
1136554c0a3aSHans de Goede psta->ldpc = 1;
1137554c0a3aSHans de Goede
1138554c0a3aSHans de Goede if (TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX))
1139554c0a3aSHans de Goede psta->stbc = 1;
1140554c0a3aSHans de Goede } else {
1141554c0a3aSHans de Goede psta->ldpc = 0;
1142554c0a3aSHans de Goede psta->stbc = 0;
1143554c0a3aSHans de Goede }
1144554c0a3aSHans de Goede }
1145554c0a3aSHans de Goede
rtw_check_bcn_info(struct adapter * Adapter,u8 * pframe,u32 packet_len)1146554c0a3aSHans de Goede int rtw_check_bcn_info(struct adapter *Adapter, u8 *pframe, u32 packet_len)
1147554c0a3aSHans de Goede {
1148554c0a3aSHans de Goede unsigned int len;
1149554c0a3aSHans de Goede unsigned char *p;
1150554c0a3aSHans de Goede unsigned short val16, subtype;
1151554c0a3aSHans de Goede struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network);
1152554c0a3aSHans de Goede /* u8 wpa_ie[255], rsn_ie[255]; */
1153554c0a3aSHans de Goede u16 wpa_len = 0, rsn_len = 0;
1154554c0a3aSHans de Goede u8 encryp_protocol = 0;
1155554c0a3aSHans de Goede struct wlan_bssid_ex *bssid;
1156554c0a3aSHans de Goede int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0;
1157554c0a3aSHans de Goede unsigned char *pbuf;
1158554c0a3aSHans de Goede u32 wpa_ielen = 0;
1159554c0a3aSHans de Goede u8 *pbssid = GetAddr3Ptr(pframe);
1160554c0a3aSHans de Goede struct HT_info_element *pht_info = NULL;
1161c25d8a7dSRoss Schmidt struct ieee80211_ht_cap *pht_cap = NULL;
1162554c0a3aSHans de Goede u32 bcn_channel;
1163554c0a3aSHans de Goede unsigned short ht_cap_info;
1164554c0a3aSHans de Goede unsigned char ht_info_infos_0;
1165554c0a3aSHans de Goede struct mlme_priv *pmlmepriv = &Adapter->mlmepriv;
116637073089SDenis Straghkov int ssid_len;
1167554c0a3aSHans de Goede
1168554c0a3aSHans de Goede if (is_client_associated_to_ap(Adapter) == false)
1169554c0a3aSHans de Goede return true;
1170554c0a3aSHans de Goede
1171554c0a3aSHans de Goede len = packet_len - sizeof(struct ieee80211_hdr_3addr);
1172554c0a3aSHans de Goede
1173709c8e49SFabio Aiuto if (len > MAX_IE_SZ)
1174554c0a3aSHans de Goede return _FAIL;
1175554c0a3aSHans de Goede
1176d3fcee1bSFabio Aiuto if (memcmp(cur_network->network.mac_address, pbssid, 6))
1177554c0a3aSHans de Goede return true;
1178554c0a3aSHans de Goede
11792ef2b7c2SJoe Perches bssid = rtw_zmalloc(sizeof(struct wlan_bssid_ex));
1180709c8e49SFabio Aiuto if (!bssid)
1181554c0a3aSHans de Goede return true;
1182554c0a3aSHans de Goede
1183554c0a3aSHans de Goede if ((pmlmepriv->timeBcnInfoChkStart != 0) && (jiffies_to_msecs(jiffies - pmlmepriv->timeBcnInfoChkStart) > DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS)) {
1184554c0a3aSHans de Goede pmlmepriv->timeBcnInfoChkStart = 0;
1185554c0a3aSHans de Goede pmlmepriv->NumOfBcnInfoChkFail = 0;
1186554c0a3aSHans de Goede }
1187554c0a3aSHans de Goede
1188554c0a3aSHans de Goede subtype = GetFrameSubType(pframe) >> 4;
1189554c0a3aSHans de Goede
1190554c0a3aSHans de Goede if (subtype == WIFI_BEACON)
119176ac3b19SFabio Aiuto bssid->reserved[0] = 1;
1192554c0a3aSHans de Goede
1193d3fcee1bSFabio Aiuto bssid->length = sizeof(struct wlan_bssid_ex) - MAX_IE_SZ + len;
1194554c0a3aSHans de Goede
1195554c0a3aSHans de Goede /* below is to copy the information element */
1196d3fcee1bSFabio Aiuto bssid->ie_length = len;
1197d3fcee1bSFabio Aiuto memcpy(bssid->ies, (pframe + sizeof(struct ieee80211_hdr_3addr)), bssid->ie_length);
1198554c0a3aSHans de Goede
1199554c0a3aSHans de Goede /* check bw and channel offset */
1200554c0a3aSHans de Goede /* parsing HT_CAP_IE */
1201d3fcee1bSFabio Aiuto p = rtw_get_ie(bssid->ies + _FIXED_IE_LENGTH_, WLAN_EID_HT_CAPABILITY, &len, bssid->ie_length - _FIXED_IE_LENGTH_);
1202554c0a3aSHans de Goede if (p && len > 0) {
1203c25d8a7dSRoss Schmidt pht_cap = (struct ieee80211_ht_cap *)(p + 2);
1204554c0a3aSHans de Goede ht_cap_info = le16_to_cpu(pht_cap->cap_info);
1205554c0a3aSHans de Goede } else {
1206554c0a3aSHans de Goede ht_cap_info = 0;
1207554c0a3aSHans de Goede }
1208554c0a3aSHans de Goede /* parsing HT_INFO_IE */
1209d3fcee1bSFabio Aiuto p = rtw_get_ie(bssid->ies + _FIXED_IE_LENGTH_, WLAN_EID_HT_OPERATION, &len, bssid->ie_length - _FIXED_IE_LENGTH_);
1210554c0a3aSHans de Goede if (p && len > 0) {
1211554c0a3aSHans de Goede pht_info = (struct HT_info_element *)(p + 2);
1212554c0a3aSHans de Goede ht_info_infos_0 = pht_info->infos[0];
1213554c0a3aSHans de Goede } else {
1214554c0a3aSHans de Goede ht_info_infos_0 = 0;
1215554c0a3aSHans de Goede }
1216d7361874SFabio Aiuto if (ht_cap_info != cur_network->bcn_info.ht_cap_info ||
1217d7361874SFabio Aiuto ((ht_info_infos_0&0x03) != (cur_network->bcn_info.ht_info_infos_0&0x03))) {
1218554c0a3aSHans de Goede {
1219554c0a3aSHans de Goede /* bcn_info_update */
1220d7361874SFabio Aiuto cur_network->bcn_info.ht_cap_info = ht_cap_info;
1221d7361874SFabio Aiuto cur_network->bcn_info.ht_info_infos_0 = ht_info_infos_0;
1222554c0a3aSHans de Goede /* to do : need to check that whether modify related register of BB or not */
1223554c0a3aSHans de Goede }
1224554c0a3aSHans de Goede /* goto _mismatch; */
1225554c0a3aSHans de Goede }
1226554c0a3aSHans de Goede
1227554c0a3aSHans de Goede /* Checking for channel */
1228d3fcee1bSFabio Aiuto p = rtw_get_ie(bssid->ies + _FIXED_IE_LENGTH_, WLAN_EID_DS_PARAMS, &len, bssid->ie_length - _FIXED_IE_LENGTH_);
1229554c0a3aSHans de Goede if (p) {
1230554c0a3aSHans de Goede bcn_channel = *(p + 2);
1231554c0a3aSHans de Goede } else {/* In 5G, some ap do not have DSSET IE checking HT info for channel */
1232d3fcee1bSFabio Aiuto rtw_get_ie(bssid->ies + _FIXED_IE_LENGTH_, WLAN_EID_HT_OPERATION,
1233d3fcee1bSFabio Aiuto &len, bssid->ie_length - _FIXED_IE_LENGTH_);
1234709c8e49SFabio Aiuto if (pht_info)
1235554c0a3aSHans de Goede bcn_channel = pht_info->primary_channel;
1236709c8e49SFabio Aiuto else /* we don't find channel IE, so don't check it */
1237554c0a3aSHans de Goede bcn_channel = Adapter->mlmeextpriv.cur_channel;
1238554c0a3aSHans de Goede }
1239709c8e49SFabio Aiuto
1240709c8e49SFabio Aiuto if (bcn_channel != Adapter->mlmeextpriv.cur_channel)
1241554c0a3aSHans de Goede goto _mismatch;
1242554c0a3aSHans de Goede
1243554c0a3aSHans de Goede /* checking SSID */
124437073089SDenis Straghkov ssid_len = 0;
1245d3fcee1bSFabio Aiuto p = rtw_get_ie(bssid->ies + _FIXED_IE_LENGTH_, WLAN_EID_SSID, &len, bssid->ie_length - _FIXED_IE_LENGTH_);
124637073089SDenis Straghkov if (p) {
124737073089SDenis Straghkov ssid_len = *(p + 1);
124837073089SDenis Straghkov if (ssid_len > NDIS_802_11_LENGTH_SSID)
124937073089SDenis Straghkov ssid_len = 0;
1250554c0a3aSHans de Goede }
12516994aa43SFabio Aiuto memcpy(bssid->ssid.ssid, (p + 2), ssid_len);
12526994aa43SFabio Aiuto bssid->ssid.ssid_length = ssid_len;
1253554c0a3aSHans de Goede
12546994aa43SFabio Aiuto if (memcmp(bssid->ssid.ssid, cur_network->network.ssid.ssid, 32) ||
12556994aa43SFabio Aiuto bssid->ssid.ssid_length != cur_network->network.ssid.ssid_length)
12566994aa43SFabio Aiuto if (bssid->ssid.ssid[0] != '\0' &&
12576994aa43SFabio Aiuto bssid->ssid.ssid_length != 0) /* not hidden ssid */
1258554c0a3aSHans de Goede goto _mismatch;
1259554c0a3aSHans de Goede
1260554c0a3aSHans de Goede /* check encryption info */
1261554c0a3aSHans de Goede val16 = rtw_get_capability((struct wlan_bssid_ex *)bssid);
1262554c0a3aSHans de Goede
1263554c0a3aSHans de Goede if (val16 & BIT(4))
1264d3fcee1bSFabio Aiuto bssid->privacy = 1;
1265554c0a3aSHans de Goede else
1266d3fcee1bSFabio Aiuto bssid->privacy = 0;
1267554c0a3aSHans de Goede
1268d3fcee1bSFabio Aiuto if (cur_network->network.privacy != bssid->privacy)
1269554c0a3aSHans de Goede goto _mismatch;
1270554c0a3aSHans de Goede
1271d3fcee1bSFabio Aiuto rtw_get_sec_ie(bssid->ies, bssid->ie_length, NULL, &rsn_len, NULL, &wpa_len);
1272554c0a3aSHans de Goede
1273709c8e49SFabio Aiuto if (rsn_len > 0)
1274554c0a3aSHans de Goede encryp_protocol = ENCRYP_PROTOCOL_WPA2;
1275709c8e49SFabio Aiuto else if (wpa_len > 0)
1276554c0a3aSHans de Goede encryp_protocol = ENCRYP_PROTOCOL_WPA;
1277709c8e49SFabio Aiuto else
1278d3fcee1bSFabio Aiuto if (bssid->privacy)
1279554c0a3aSHans de Goede encryp_protocol = ENCRYP_PROTOCOL_WEP;
1280554c0a3aSHans de Goede
1281d7361874SFabio Aiuto if (cur_network->bcn_info.encryp_protocol != encryp_protocol)
1282554c0a3aSHans de Goede goto _mismatch;
1283554c0a3aSHans de Goede
1284554c0a3aSHans de Goede if (encryp_protocol == ENCRYP_PROTOCOL_WPA || encryp_protocol == ENCRYP_PROTOCOL_WPA2) {
1285d3fcee1bSFabio Aiuto pbuf = rtw_get_wpa_ie(&bssid->ies[12], &wpa_ielen, bssid->ie_length-12);
1286554c0a3aSHans de Goede if (pbuf && (wpa_ielen > 0)) {
12873cebd895SFabio Aiuto rtw_parse_wpa_ie(pbuf, wpa_ielen + 2, &group_cipher,
12883cebd895SFabio Aiuto &pairwise_cipher, &is_8021x);
1289554c0a3aSHans de Goede } else {
1290d3fcee1bSFabio Aiuto pbuf = rtw_get_wpa2_ie(&bssid->ies[12], &wpa_ielen, bssid->ie_length-12);
1291554c0a3aSHans de Goede
1292709c8e49SFabio Aiuto if (pbuf && (wpa_ielen > 0))
12933cebd895SFabio Aiuto rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher,
12943cebd895SFabio Aiuto &pairwise_cipher, &is_8021x);
1295554c0a3aSHans de Goede }
1296554c0a3aSHans de Goede
1297d7361874SFabio Aiuto if (pairwise_cipher != cur_network->bcn_info.pairwise_cipher ||
1298d7361874SFabio Aiuto group_cipher != cur_network->bcn_info.group_cipher)
1299554c0a3aSHans de Goede goto _mismatch;
1300554c0a3aSHans de Goede
1301d7361874SFabio Aiuto if (is_8021x != cur_network->bcn_info.is_8021x)
1302554c0a3aSHans de Goede goto _mismatch;
1303554c0a3aSHans de Goede }
1304554c0a3aSHans de Goede
13052dac96b3SNachammai Karuppiah kfree(bssid);
1306554c0a3aSHans de Goede return _SUCCESS;
1307554c0a3aSHans de Goede
1308554c0a3aSHans de Goede _mismatch:
13092dac96b3SNachammai Karuppiah kfree(bssid);
1310554c0a3aSHans de Goede
1311554c0a3aSHans de Goede if (pmlmepriv->NumOfBcnInfoChkFail == 0)
1312554c0a3aSHans de Goede pmlmepriv->timeBcnInfoChkStart = jiffies;
1313554c0a3aSHans de Goede
1314554c0a3aSHans de Goede pmlmepriv->NumOfBcnInfoChkFail++;
1315554c0a3aSHans de Goede
1316554c0a3aSHans de Goede if ((pmlmepriv->timeBcnInfoChkStart != 0) && (jiffies_to_msecs(jiffies - pmlmepriv->timeBcnInfoChkStart) <= DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS)
1317554c0a3aSHans de Goede && (pmlmepriv->NumOfBcnInfoChkFail >= DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD)) {
1318554c0a3aSHans de Goede pmlmepriv->timeBcnInfoChkStart = 0;
1319554c0a3aSHans de Goede pmlmepriv->NumOfBcnInfoChkFail = 0;
1320554c0a3aSHans de Goede return _FAIL;
1321554c0a3aSHans de Goede }
1322554c0a3aSHans de Goede
1323554c0a3aSHans de Goede return _SUCCESS;
1324554c0a3aSHans de Goede }
1325554c0a3aSHans de Goede
update_beacon_info(struct adapter * padapter,u8 * pframe,uint pkt_len,struct sta_info * psta)1326554c0a3aSHans de Goede void update_beacon_info(struct adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta)
1327554c0a3aSHans de Goede {
1328554c0a3aSHans de Goede unsigned int i;
1329554c0a3aSHans de Goede unsigned int len;
1330554c0a3aSHans de Goede struct ndis_80211_var_ie *pIE;
1331554c0a3aSHans de Goede
1332554c0a3aSHans de Goede len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN);
1333554c0a3aSHans de Goede
1334554c0a3aSHans de Goede for (i = 0; i < len;) {
1335554c0a3aSHans de Goede pIE = (struct ndis_80211_var_ie *)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i);
1336554c0a3aSHans de Goede
133761ba4faeSFabio Aiuto switch (pIE->element_id) {
1338b05cc3a9SRoss Schmidt case WLAN_EID_VENDOR_SPECIFIC:
1339858ea450SR Veera Kumar /* to update WMM parameter set while receiving beacon */
134061ba4faeSFabio Aiuto if (!memcmp(pIE->data, WMM_PARA_OUI, 6) && pIE->length == WLAN_WMM_LEN) /* WMM */
1341554c0a3aSHans de Goede if (WMM_param_handler(padapter, pIE))
1342554c0a3aSHans de Goede report_wmm_edca_update(padapter);
1343554c0a3aSHans de Goede
1344554c0a3aSHans de Goede break;
1345554c0a3aSHans de Goede
1346332ec9dbSRoss Schmidt case WLAN_EID_HT_OPERATION: /* HT info */
1347554c0a3aSHans de Goede /* HT_info_handler(padapter, pIE); */
1348554c0a3aSHans de Goede bwmode_update_check(padapter, pIE);
1349554c0a3aSHans de Goede break;
1350554c0a3aSHans de Goede
13517bd332ecSRoss Schmidt case WLAN_EID_ERP_INFO:
1352554c0a3aSHans de Goede ERP_IE_handler(padapter, pIE);
1353554c0a3aSHans de Goede VCS_update(padapter, psta);
1354554c0a3aSHans de Goede break;
1355554c0a3aSHans de Goede
1356554c0a3aSHans de Goede default:
1357554c0a3aSHans de Goede break;
1358554c0a3aSHans de Goede }
1359554c0a3aSHans de Goede
136061ba4faeSFabio Aiuto i += (pIE->length + 2);
1361554c0a3aSHans de Goede }
1362554c0a3aSHans de Goede }
1363554c0a3aSHans de Goede
is_ap_in_tkip(struct adapter * padapter)1364554c0a3aSHans de Goede unsigned int is_ap_in_tkip(struct adapter *padapter)
1365554c0a3aSHans de Goede {
1366554c0a3aSHans de Goede u32 i;
1367554c0a3aSHans de Goede struct ndis_80211_var_ie *pIE;
1368554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1369554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1370554c0a3aSHans de Goede struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network);
1371554c0a3aSHans de Goede
1372554c0a3aSHans de Goede if (rtw_get_capability((struct wlan_bssid_ex *)cur_network) & WLAN_CAPABILITY_PRIVACY) {
1373d3fcee1bSFabio Aiuto for (i = sizeof(struct ndis_802_11_fix_ie); i < pmlmeinfo->network.ie_length;) {
1374d3fcee1bSFabio Aiuto pIE = (struct ndis_80211_var_ie *)(pmlmeinfo->network.ies + i);
1375554c0a3aSHans de Goede
137661ba4faeSFabio Aiuto switch (pIE->element_id) {
1377b05cc3a9SRoss Schmidt case WLAN_EID_VENDOR_SPECIFIC:
1378554c0a3aSHans de Goede if ((!memcmp(pIE->data, RTW_WPA_OUI, 4)) && (!memcmp((pIE->data + 12), WPA_TKIP_CIPHER, 4)))
1379554c0a3aSHans de Goede return true;
1380554c0a3aSHans de Goede
1381554c0a3aSHans de Goede break;
1382554c0a3aSHans de Goede
13833359e292SRoss Schmidt case WLAN_EID_RSN:
1384554c0a3aSHans de Goede if (!memcmp((pIE->data + 8), RSN_TKIP_CIPHER, 4))
1385554c0a3aSHans de Goede return true;
13862811861bSGustavo A. R. Silva break;
1387554c0a3aSHans de Goede
1388554c0a3aSHans de Goede default:
1389554c0a3aSHans de Goede break;
1390554c0a3aSHans de Goede }
1391554c0a3aSHans de Goede
139261ba4faeSFabio Aiuto i += (pIE->length + 2);
1393554c0a3aSHans de Goede }
1394554c0a3aSHans de Goede
1395554c0a3aSHans de Goede return false;
139670466c39SRoss Schmidt } else {
1397554c0a3aSHans de Goede return false;
1398554c0a3aSHans de Goede }
139970466c39SRoss Schmidt }
1400554c0a3aSHans de Goede
support_short_GI(struct adapter * padapter,struct HT_caps_element * pHT_caps,u8 bwmode)1401554c0a3aSHans de Goede int support_short_GI(struct adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode)
1402554c0a3aSHans de Goede {
1403554c0a3aSHans de Goede unsigned char bit_offset;
1404554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1405554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1406554c0a3aSHans de Goede
1407554c0a3aSHans de Goede if (!(pmlmeinfo->HT_enable))
1408554c0a3aSHans de Goede return _FAIL;
1409554c0a3aSHans de Goede
1410554c0a3aSHans de Goede bit_offset = (bwmode & CHANNEL_WIDTH_40) ? 6 : 5;
1411554c0a3aSHans de Goede
1412554c0a3aSHans de Goede if (le16_to_cpu(pHT_caps->u.HT_cap_element.HT_caps_info) & (0x1 << bit_offset))
1413554c0a3aSHans de Goede return _SUCCESS;
1414554c0a3aSHans de Goede else
1415554c0a3aSHans de Goede return _FAIL;
1416554c0a3aSHans de Goede }
1417554c0a3aSHans de Goede
get_highest_rate_idx(u32 mask)1418554c0a3aSHans de Goede unsigned char get_highest_rate_idx(u32 mask)
1419554c0a3aSHans de Goede {
1420554c0a3aSHans de Goede int i;
1421554c0a3aSHans de Goede unsigned char rate_idx = 0;
1422554c0a3aSHans de Goede
1423554c0a3aSHans de Goede for (i = 31; i >= 0; i--) {
1424554c0a3aSHans de Goede if (mask & BIT(i)) {
1425554c0a3aSHans de Goede rate_idx = i;
1426554c0a3aSHans de Goede break;
1427554c0a3aSHans de Goede }
1428554c0a3aSHans de Goede }
1429554c0a3aSHans de Goede
1430554c0a3aSHans de Goede return rate_idx;
1431554c0a3aSHans de Goede }
1432554c0a3aSHans de Goede
Update_RA_Entry(struct adapter * padapter,struct sta_info * psta)1433554c0a3aSHans de Goede void Update_RA_Entry(struct adapter *padapter, struct sta_info *psta)
1434554c0a3aSHans de Goede {
1435554c0a3aSHans de Goede rtw_hal_update_ra_mask(psta, 0);
1436554c0a3aSHans de Goede }
1437554c0a3aSHans de Goede
set_sta_rate(struct adapter * padapter,struct sta_info * psta)1438554c0a3aSHans de Goede void set_sta_rate(struct adapter *padapter, struct sta_info *psta)
1439554c0a3aSHans de Goede {
1440554c0a3aSHans de Goede /* rate adaptive */
1441183eb53dSNishka Dasgupta Update_RA_Entry(padapter, psta);
1442554c0a3aSHans de Goede }
1443554c0a3aSHans de Goede
get_realtek_assoc_AP_vender(struct ndis_80211_var_ie * pIE)14443c8c577fSShreyansh Chouhan static u32 get_realtek_assoc_AP_vender(struct ndis_80211_var_ie *pIE)
1445554c0a3aSHans de Goede {
1446554c0a3aSHans de Goede u32 Vender = HT_IOT_PEER_REALTEK;
1447554c0a3aSHans de Goede
144861ba4faeSFabio Aiuto if (pIE->length >= 5) {
1449554c0a3aSHans de Goede if (pIE->data[4] == 1)
1450554c0a3aSHans de Goede /* if (pIE->data[5] & RT_HT_CAP_USE_LONG_PREAMBLE) */
1451554c0a3aSHans de Goede /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_LONG_PREAMBLE; */
1452554c0a3aSHans de Goede if (pIE->data[5] & RT_HT_CAP_USE_92SE)
1453554c0a3aSHans de Goede /* bssDesc->BssHT.RT2RT_HT_Mode |= RT_HT_CAP_USE_92SE; */
1454554c0a3aSHans de Goede Vender = HT_IOT_PEER_REALTEK_92SE;
1455554c0a3aSHans de Goede
1456554c0a3aSHans de Goede if (pIE->data[5] & RT_HT_CAP_USE_SOFTAP)
1457554c0a3aSHans de Goede Vender = HT_IOT_PEER_REALTEK_SOFTAP;
1458554c0a3aSHans de Goede
1459554c0a3aSHans de Goede if (pIE->data[4] == 2) {
1460709c8e49SFabio Aiuto if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_BCUT)
1461554c0a3aSHans de Goede Vender = HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP;
1462709c8e49SFabio Aiuto
1463709c8e49SFabio Aiuto if (pIE->data[6] & RT_HT_CAP_USE_JAGUAR_CCUT)
1464554c0a3aSHans de Goede Vender = HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP;
1465554c0a3aSHans de Goede }
1466554c0a3aSHans de Goede }
1467554c0a3aSHans de Goede
1468554c0a3aSHans de Goede return Vender;
14693c8c577fSShreyansh Chouhan }
14703c8c577fSShreyansh Chouhan
check_assoc_AP(u8 * pframe,uint len)14713c8c577fSShreyansh Chouhan unsigned char check_assoc_AP(u8 *pframe, uint len)
14723c8c577fSShreyansh Chouhan {
14733c8c577fSShreyansh Chouhan unsigned int i;
14743c8c577fSShreyansh Chouhan struct ndis_80211_var_ie *pIE;
14753c8c577fSShreyansh Chouhan
14763c8c577fSShreyansh Chouhan for (i = sizeof(struct ndis_802_11_fix_ie); i < len;) {
14773c8c577fSShreyansh Chouhan pIE = (struct ndis_80211_var_ie *)(pframe + i);
14783c8c577fSShreyansh Chouhan
147961ba4faeSFabio Aiuto switch (pIE->element_id) {
14803c8c577fSShreyansh Chouhan case WLAN_EID_VENDOR_SPECIFIC:
14818f5193f8SShreyansh Chouhan if ((!memcmp(pIE->data, ARTHEROS_OUI1, 3)) || (!memcmp(pIE->data, ARTHEROS_OUI2, 3)))
14823c8c577fSShreyansh Chouhan return HT_IOT_PEER_ATHEROS;
14838f5193f8SShreyansh Chouhan else if ((!memcmp(pIE->data, BROADCOM_OUI1, 3)) ||
14843c8c577fSShreyansh Chouhan (!memcmp(pIE->data, BROADCOM_OUI2, 3)) ||
14858f5193f8SShreyansh Chouhan (!memcmp(pIE->data, BROADCOM_OUI3, 3)))
14863c8c577fSShreyansh Chouhan return HT_IOT_PEER_BROADCOM;
14878f5193f8SShreyansh Chouhan else if (!memcmp(pIE->data, MARVELL_OUI, 3))
14883c8c577fSShreyansh Chouhan return HT_IOT_PEER_MARVELL;
14898f5193f8SShreyansh Chouhan else if (!memcmp(pIE->data, RALINK_OUI, 3))
14903c8c577fSShreyansh Chouhan return HT_IOT_PEER_RALINK;
14918f5193f8SShreyansh Chouhan else if (!memcmp(pIE->data, CISCO_OUI, 3))
14923c8c577fSShreyansh Chouhan return HT_IOT_PEER_CISCO;
14938f5193f8SShreyansh Chouhan else if (!memcmp(pIE->data, REALTEK_OUI, 3))
14943c8c577fSShreyansh Chouhan return get_realtek_assoc_AP_vender(pIE);
14958f5193f8SShreyansh Chouhan else if (!memcmp(pIE->data, AIRGOCAP_OUI, 3))
1496554c0a3aSHans de Goede return HT_IOT_PEER_AIRGO;
14978f5193f8SShreyansh Chouhan else
1498554c0a3aSHans de Goede break;
1499554c0a3aSHans de Goede
1500554c0a3aSHans de Goede default:
1501554c0a3aSHans de Goede break;
1502554c0a3aSHans de Goede }
1503554c0a3aSHans de Goede
150461ba4faeSFabio Aiuto i += (pIE->length + 2);
1505554c0a3aSHans de Goede }
1506554c0a3aSHans de Goede
1507554c0a3aSHans de Goede return HT_IOT_PEER_UNKNOWN;
1508554c0a3aSHans de Goede }
1509554c0a3aSHans de Goede
update_IOT_info(struct adapter * padapter)1510554c0a3aSHans de Goede void update_IOT_info(struct adapter *padapter)
1511554c0a3aSHans de Goede {
1512554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1513554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1514554c0a3aSHans de Goede
1515554c0a3aSHans de Goede switch (pmlmeinfo->assoc_AP_vendor) {
1516554c0a3aSHans de Goede case HT_IOT_PEER_MARVELL:
1517554c0a3aSHans de Goede pmlmeinfo->turboMode_cts2self = 1;
1518554c0a3aSHans de Goede pmlmeinfo->turboMode_rtsen = 0;
1519554c0a3aSHans de Goede break;
1520554c0a3aSHans de Goede
1521554c0a3aSHans de Goede case HT_IOT_PEER_RALINK:
1522554c0a3aSHans de Goede pmlmeinfo->turboMode_cts2self = 0;
1523554c0a3aSHans de Goede pmlmeinfo->turboMode_rtsen = 1;
1524554c0a3aSHans de Goede /* disable high power */
1525554c0a3aSHans de Goede Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false);
1526554c0a3aSHans de Goede break;
1527554c0a3aSHans de Goede case HT_IOT_PEER_REALTEK:
1528554c0a3aSHans de Goede /* rtw_write16(padapter, 0x4cc, 0xffff); */
1529554c0a3aSHans de Goede /* rtw_write16(padapter, 0x546, 0x01c0); */
1530554c0a3aSHans de Goede /* disable high power */
1531554c0a3aSHans de Goede Switch_DM_Func(padapter, (~DYNAMIC_BB_DYNAMIC_TXPWR), false);
1532554c0a3aSHans de Goede break;
1533554c0a3aSHans de Goede default:
1534554c0a3aSHans de Goede pmlmeinfo->turboMode_cts2self = 0;
1535554c0a3aSHans de Goede pmlmeinfo->turboMode_rtsen = 1;
1536554c0a3aSHans de Goede break;
1537554c0a3aSHans de Goede }
1538554c0a3aSHans de Goede }
1539554c0a3aSHans de Goede
update_capinfo(struct adapter * Adapter,u16 updateCap)1540554c0a3aSHans de Goede void update_capinfo(struct adapter *Adapter, u16 updateCap)
1541554c0a3aSHans de Goede {
1542554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv;
1543554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1544554c0a3aSHans de Goede bool ShortPreamble;
1545554c0a3aSHans de Goede
1546554c0a3aSHans de Goede /* Check preamble mode, 2005.01.06, by rcnjko. */
1547554c0a3aSHans de Goede /* Mark to update preamble value forever, 2008.03.18 by lanhsin */
1548554c0a3aSHans de Goede /* if (pMgntInfo->RegPreambleMode == PREAMBLE_AUTO) */
1549554c0a3aSHans de Goede {
1550554c0a3aSHans de Goede if (updateCap & cShortPreamble) {
1551554c0a3aSHans de Goede /* Short Preamble */
1552554c0a3aSHans de Goede if (pmlmeinfo->preamble_mode != PREAMBLE_SHORT) { /* PREAMBLE_LONG or PREAMBLE_AUTO */
1553554c0a3aSHans de Goede ShortPreamble = true;
1554554c0a3aSHans de Goede pmlmeinfo->preamble_mode = PREAMBLE_SHORT;
1555554c0a3aSHans de Goede rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble);
1556554c0a3aSHans de Goede }
1557554c0a3aSHans de Goede } else {
1558554c0a3aSHans de Goede /* Long Preamble */
1559554c0a3aSHans de Goede if (pmlmeinfo->preamble_mode != PREAMBLE_LONG) { /* PREAMBLE_SHORT or PREAMBLE_AUTO */
1560554c0a3aSHans de Goede ShortPreamble = false;
1561554c0a3aSHans de Goede pmlmeinfo->preamble_mode = PREAMBLE_LONG;
1562554c0a3aSHans de Goede rtw_hal_set_hwreg(Adapter, HW_VAR_ACK_PREAMBLE, (u8 *)&ShortPreamble);
1563554c0a3aSHans de Goede }
1564554c0a3aSHans de Goede }
1565554c0a3aSHans de Goede }
1566554c0a3aSHans de Goede
156770466c39SRoss Schmidt if (updateCap & cIBSS) {
1568554c0a3aSHans de Goede /* Filen: See 802.11-2007 p.91 */
1569554c0a3aSHans de Goede pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
157070466c39SRoss Schmidt } else {
1571554c0a3aSHans de Goede /* Filen: See 802.11-2007 p.90 */
1572708180a9SFabio Aiuto if (pmlmeext->cur_wireless_mode & (WIRELESS_11_24N)) {
1573554c0a3aSHans de Goede pmlmeinfo->slotTime = SHORT_SLOT_TIME;
157470466c39SRoss Schmidt } else if (pmlmeext->cur_wireless_mode & (WIRELESS_11G)) {
1575554c0a3aSHans de Goede if ((updateCap & cShortSlotTime) /* && (!(pMgntInfo->pHTInfo->RT2RT_HT_Mode & RT_HT_CAP_USE_LONG_PREAMBLE)) */)
1576554c0a3aSHans de Goede /* Short Slot Time */
1577554c0a3aSHans de Goede pmlmeinfo->slotTime = SHORT_SLOT_TIME;
1578554c0a3aSHans de Goede else
1579554c0a3aSHans de Goede /* Long Slot Time */
1580554c0a3aSHans de Goede pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
158170466c39SRoss Schmidt } else {
1582554c0a3aSHans de Goede /* B Mode */
1583554c0a3aSHans de Goede pmlmeinfo->slotTime = NON_SHORT_SLOT_TIME;
1584554c0a3aSHans de Goede }
158570466c39SRoss Schmidt }
1586554c0a3aSHans de Goede
1587554c0a3aSHans de Goede rtw_hal_set_hwreg(Adapter, HW_VAR_SLOT_TIME, &pmlmeinfo->slotTime);
1588554c0a3aSHans de Goede }
1589554c0a3aSHans de Goede
update_wireless_mode(struct adapter * padapter)1590554c0a3aSHans de Goede void update_wireless_mode(struct adapter *padapter)
1591554c0a3aSHans de Goede {
15927d955952SMichael Straube int network_type = 0;
1593554c0a3aSHans de Goede u32 SIFS_Timer;
1594554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1595554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1596554c0a3aSHans de Goede struct wlan_bssid_ex *cur_network = &(pmlmeinfo->network);
1597d3fcee1bSFabio Aiuto unsigned char *rate = cur_network->supported_rates;
1598554c0a3aSHans de Goede
1599554c0a3aSHans de Goede if ((pmlmeinfo->HT_info_enable) && (pmlmeinfo->HT_caps_enable))
1600554c0a3aSHans de Goede pmlmeinfo->HT_enable = 1;
1601554c0a3aSHans de Goede
1602708180a9SFabio Aiuto if (pmlmeinfo->HT_enable)
1603554c0a3aSHans de Goede network_type = WIRELESS_11_24N;
1604554c0a3aSHans de Goede
16057d955952SMichael Straube if (rtw_is_cckratesonly_included(rate))
1606554c0a3aSHans de Goede network_type |= WIRELESS_11B;
16077d955952SMichael Straube else if (rtw_is_cckrates_included(rate))
1608554c0a3aSHans de Goede network_type |= WIRELESS_11BG;
1609554c0a3aSHans de Goede else
1610554c0a3aSHans de Goede network_type |= WIRELESS_11G;
1611554c0a3aSHans de Goede
1612554c0a3aSHans de Goede pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode;
1613554c0a3aSHans de Goede
1614554c0a3aSHans de Goede SIFS_Timer = 0x0a0a0808; /* 0x0808 -> for CCK, 0x0a0a -> for OFDM */
1615554c0a3aSHans de Goede /* change this value if having IOT issues. */
1616554c0a3aSHans de Goede
1617554c0a3aSHans de Goede padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer);
1618554c0a3aSHans de Goede
1619554c0a3aSHans de Goede padapter->HalFunc.SetHwRegHandler(padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode));
1620554c0a3aSHans de Goede
1621554c0a3aSHans de Goede if (pmlmeext->cur_wireless_mode & WIRELESS_11B)
1622554c0a3aSHans de Goede update_mgnt_tx_rate(padapter, IEEE80211_CCK_RATE_1MB);
1623554c0a3aSHans de Goede else
1624554c0a3aSHans de Goede update_mgnt_tx_rate(padapter, IEEE80211_OFDM_RATE_6MB);
1625554c0a3aSHans de Goede }
1626554c0a3aSHans de Goede
update_sta_basic_rate(struct sta_info * psta,u8 wireless_mode)1627554c0a3aSHans de Goede void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode)
1628554c0a3aSHans de Goede {
1629ef35b7a8SFabio Aiuto if (is_supported_tx_cck(wireless_mode)) {
1630554c0a3aSHans de Goede /* Only B, B/G, and B/G/N AP could use CCK rate */
1631554c0a3aSHans de Goede memcpy(psta->bssrateset, rtw_basic_rate_cck, 4);
1632554c0a3aSHans de Goede psta->bssratelen = 4;
1633554c0a3aSHans de Goede } else {
1634554c0a3aSHans de Goede memcpy(psta->bssrateset, rtw_basic_rate_ofdm, 3);
1635554c0a3aSHans de Goede psta->bssratelen = 3;
1636554c0a3aSHans de Goede }
1637554c0a3aSHans de Goede }
1638554c0a3aSHans de Goede
update_sta_support_rate(struct adapter * padapter,u8 * pvar_ie,uint var_ie_len,int cam_idx)1639554c0a3aSHans de Goede int update_sta_support_rate(struct adapter *padapter, u8 *pvar_ie, uint var_ie_len, int cam_idx)
1640554c0a3aSHans de Goede {
1641554c0a3aSHans de Goede unsigned int ie_len;
1642554c0a3aSHans de Goede struct ndis_80211_var_ie *pIE;
1643554c0a3aSHans de Goede int supportRateNum = 0;
1644554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv);
1645554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1646554c0a3aSHans de Goede
1647c34c45edSRoss Schmidt pIE = (struct ndis_80211_var_ie *)rtw_get_ie(pvar_ie, WLAN_EID_SUPP_RATES, &ie_len, var_ie_len);
1648c9d19e68SMichael Straube if (!pIE)
1649554c0a3aSHans de Goede return _FAIL;
1650b65a2d8cSDan Carpenter if (ie_len > sizeof(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates))
1651b65a2d8cSDan Carpenter return _FAIL;
1652554c0a3aSHans de Goede
1653554c0a3aSHans de Goede memcpy(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates, pIE->data, ie_len);
1654554c0a3aSHans de Goede supportRateNum = ie_len;
1655554c0a3aSHans de Goede
165600f0b682SRoss Schmidt pIE = (struct ndis_80211_var_ie *)rtw_get_ie(pvar_ie, WLAN_EID_EXT_SUPP_RATES, &ie_len, var_ie_len);
1657b65a2d8cSDan Carpenter if (pIE && (ie_len <= sizeof(pmlmeinfo->FW_sta_info[cam_idx].SupportedRates) - supportRateNum))
1658554c0a3aSHans de Goede memcpy((pmlmeinfo->FW_sta_info[cam_idx].SupportedRates + supportRateNum), pIE->data, ie_len);
1659554c0a3aSHans de Goede
1660554c0a3aSHans de Goede return _SUCCESS;
1661554c0a3aSHans de Goede }
1662554c0a3aSHans de Goede
process_addba_req(struct adapter * padapter,u8 * paddba_req,u8 * addr)1663554c0a3aSHans de Goede void process_addba_req(struct adapter *padapter, u8 *paddba_req, u8 *addr)
1664554c0a3aSHans de Goede {
1665554c0a3aSHans de Goede struct sta_info *psta;
1666c337ee00SLee Jones u16 tid, param;
1667554c0a3aSHans de Goede struct recv_reorder_ctrl *preorder_ctrl;
1668554c0a3aSHans de Goede struct sta_priv *pstapriv = &padapter->stapriv;
1669554c0a3aSHans de Goede struct ADDBA_request *preq = (struct ADDBA_request *)paddba_req;
1670554c0a3aSHans de Goede struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
1671554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1672554c0a3aSHans de Goede
1673554c0a3aSHans de Goede psta = rtw_get_stainfo(pstapriv, addr);
1674554c0a3aSHans de Goede
1675554c0a3aSHans de Goede if (psta) {
1676554c0a3aSHans de Goede param = le16_to_cpu(preq->BA_para_set);
1677554c0a3aSHans de Goede tid = (param>>2)&0x0f;
1678554c0a3aSHans de Goede
1679554c0a3aSHans de Goede preorder_ctrl = &psta->recvreorder_ctrl[tid];
1680554c0a3aSHans de Goede
1681554c0a3aSHans de Goede preorder_ctrl->indicate_seq = 0xffff;
1682554c0a3aSHans de Goede
16832646633fSAastha Gupta preorder_ctrl->enable = pmlmeinfo->accept_addba_req;
1684554c0a3aSHans de Goede }
1685554c0a3aSHans de Goede }
1686554c0a3aSHans de Goede
update_TSF(struct mlme_ext_priv * pmlmeext,u8 * pframe,uint len)1687554c0a3aSHans de Goede void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len)
1688554c0a3aSHans de Goede {
1689554c0a3aSHans de Goede u8 *pIE;
1690554c0a3aSHans de Goede __le32 *pbuf;
1691554c0a3aSHans de Goede
1692554c0a3aSHans de Goede pIE = pframe + sizeof(struct ieee80211_hdr_3addr);
1693554c0a3aSHans de Goede pbuf = (__le32 *)pIE;
1694554c0a3aSHans de Goede
1695554c0a3aSHans de Goede pmlmeext->TSFValue = le32_to_cpu(*(pbuf+1));
1696554c0a3aSHans de Goede
1697554c0a3aSHans de Goede pmlmeext->TSFValue = pmlmeext->TSFValue << 32;
1698554c0a3aSHans de Goede
1699554c0a3aSHans de Goede pmlmeext->TSFValue |= le32_to_cpu(*pbuf);
1700554c0a3aSHans de Goede }
1701554c0a3aSHans de Goede
correct_TSF(struct adapter * padapter,struct mlme_ext_priv * pmlmeext)1702554c0a3aSHans de Goede void correct_TSF(struct adapter *padapter, struct mlme_ext_priv *pmlmeext)
1703554c0a3aSHans de Goede {
1704554c0a3aSHans de Goede rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, NULL);
1705554c0a3aSHans de Goede }
1706554c0a3aSHans de Goede
adaptive_early_32k(struct mlme_ext_priv * pmlmeext,u8 * pframe,uint len)1707554c0a3aSHans de Goede void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len)
1708554c0a3aSHans de Goede {
1709554c0a3aSHans de Goede int i;
1710554c0a3aSHans de Goede u8 *pIE;
1711554c0a3aSHans de Goede __le32 *pbuf;
1712554c0a3aSHans de Goede u64 tsf = 0;
1713554c0a3aSHans de Goede u32 delay_ms;
1714554c0a3aSHans de Goede struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info);
1715554c0a3aSHans de Goede
1716554c0a3aSHans de Goede pmlmeext->bcn_cnt++;
1717554c0a3aSHans de Goede
1718554c0a3aSHans de Goede pIE = pframe + sizeof(struct ieee80211_hdr_3addr);
1719554c0a3aSHans de Goede pbuf = (__le32 *)pIE;
1720554c0a3aSHans de Goede
1721554c0a3aSHans de Goede tsf = le32_to_cpu(*(pbuf+1));
1722554c0a3aSHans de Goede tsf = tsf << 32;
1723554c0a3aSHans de Goede tsf |= le32_to_cpu(*pbuf);
1724554c0a3aSHans de Goede
1725554c0a3aSHans de Goede /* delay = (timestamp mod 1024*100)/1000 (unit: ms) */
1726554c0a3aSHans de Goede /* delay_ms = do_div(tsf, (pmlmeinfo->bcn_interval*1024))/1000; */
17279b1fd9b0SNishka Dasgupta delay_ms = do_div(tsf, (pmlmeinfo->bcn_interval*1024));
1728554c0a3aSHans de Goede delay_ms = delay_ms/1000;
1729554c0a3aSHans de Goede
1730554c0a3aSHans de Goede if (delay_ms >= 8)
1731554c0a3aSHans de Goede pmlmeext->bcn_delay_cnt[8]++;
1732554c0a3aSHans de Goede /* pmlmeext->bcn_delay_ratio[8] = (pmlmeext->bcn_delay_cnt[8] * 100) /pmlmeext->bcn_cnt; */
1733554c0a3aSHans de Goede else
1734554c0a3aSHans de Goede pmlmeext->bcn_delay_cnt[delay_ms]++;
1735554c0a3aSHans de Goede /* pmlmeext->bcn_delay_ratio[delay_ms] = (pmlmeext->bcn_delay_cnt[delay_ms] * 100) /pmlmeext->bcn_cnt; */
1736554c0a3aSHans de Goede
1737554c0a3aSHans de Goede /*
1738554c0a3aSHans de Goede
1739554c0a3aSHans de Goede for (i = 0; i<9; i++)
1740554c0a3aSHans de Goede {
1741554c0a3aSHans de Goede pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]);
1742554c0a3aSHans de Goede }
1743554c0a3aSHans de Goede */
1744554c0a3aSHans de Goede
1745554c0a3aSHans de Goede /* dump for adaptive_early_32k */
1746554c0a3aSHans de Goede if (pmlmeext->bcn_cnt > 100 && (pmlmeext->adaptive_tsf_done == true)) {
1747554c0a3aSHans de Goede u8 ratio_20_delay, ratio_80_delay;
1748554c0a3aSHans de Goede u8 DrvBcnEarly, DrvBcnTimeOut;
1749554c0a3aSHans de Goede
1750554c0a3aSHans de Goede ratio_20_delay = 0;
1751554c0a3aSHans de Goede ratio_80_delay = 0;
1752554c0a3aSHans de Goede DrvBcnEarly = 0xff;
1753554c0a3aSHans de Goede DrvBcnTimeOut = 0xff;
1754554c0a3aSHans de Goede
1755554c0a3aSHans de Goede for (i = 0; i < 9; i++) {
1756554c0a3aSHans de Goede pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt;
1757554c0a3aSHans de Goede
1758554c0a3aSHans de Goede ratio_20_delay += pmlmeext->bcn_delay_ratio[i];
1759554c0a3aSHans de Goede ratio_80_delay += pmlmeext->bcn_delay_ratio[i];
1760554c0a3aSHans de Goede
1761709c8e49SFabio Aiuto if (ratio_20_delay > 20 && DrvBcnEarly == 0xff)
1762554c0a3aSHans de Goede DrvBcnEarly = i;
1763554c0a3aSHans de Goede
1764709c8e49SFabio Aiuto if (ratio_80_delay > 80 && DrvBcnTimeOut == 0xff)
1765554c0a3aSHans de Goede DrvBcnTimeOut = i;
1766554c0a3aSHans de Goede
1767554c0a3aSHans de Goede /* reset adaptive_early_32k cnt */
1768554c0a3aSHans de Goede pmlmeext->bcn_delay_cnt[i] = 0;
1769554c0a3aSHans de Goede pmlmeext->bcn_delay_ratio[i] = 0;
1770554c0a3aSHans de Goede }
1771554c0a3aSHans de Goede
1772554c0a3aSHans de Goede pmlmeext->DrvBcnEarly = DrvBcnEarly;
1773554c0a3aSHans de Goede pmlmeext->DrvBcnTimeOut = DrvBcnTimeOut;
1774554c0a3aSHans de Goede
1775554c0a3aSHans de Goede pmlmeext->bcn_cnt = 0;
1776554c0a3aSHans de Goede }
1777554c0a3aSHans de Goede }
1778554c0a3aSHans de Goede
rtw_alloc_macid(struct adapter * padapter,struct sta_info * psta)1779554c0a3aSHans de Goede void rtw_alloc_macid(struct adapter *padapter, struct sta_info *psta)
1780554c0a3aSHans de Goede {
1781554c0a3aSHans de Goede int i;
1782554c0a3aSHans de Goede struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter);
1783554c0a3aSHans de Goede
1784*2f59ee3fSYang Yingliang if (is_broadcast_ether_addr(psta->hwaddr))
1785554c0a3aSHans de Goede return;
1786554c0a3aSHans de Goede
1787554c0a3aSHans de Goede if (!memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN)) {
1788554c0a3aSHans de Goede psta->mac_id = NUM_STA;
1789554c0a3aSHans de Goede return;
1790554c0a3aSHans de Goede }
1791554c0a3aSHans de Goede
1792554c0a3aSHans de Goede spin_lock_bh(&pdvobj->lock);
1793554c0a3aSHans de Goede for (i = 0; i < NUM_STA; i++) {
1794554c0a3aSHans de Goede if (pdvobj->macid[i] == false) {
1795554c0a3aSHans de Goede pdvobj->macid[i] = true;
1796554c0a3aSHans de Goede break;
1797554c0a3aSHans de Goede }
1798554c0a3aSHans de Goede }
1799554c0a3aSHans de Goede spin_unlock_bh(&pdvobj->lock);
1800554c0a3aSHans de Goede
1801709c8e49SFabio Aiuto if (i > (NUM_STA - 1))
1802554c0a3aSHans de Goede psta->mac_id = NUM_STA;
1803709c8e49SFabio Aiuto else
1804554c0a3aSHans de Goede psta->mac_id = i;
1805554c0a3aSHans de Goede }
1806554c0a3aSHans de Goede
rtw_release_macid(struct adapter * padapter,struct sta_info * psta)1807554c0a3aSHans de Goede void rtw_release_macid(struct adapter *padapter, struct sta_info *psta)
1808554c0a3aSHans de Goede {
1809554c0a3aSHans de Goede struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter);
1810554c0a3aSHans de Goede
1811*2f59ee3fSYang Yingliang if (is_broadcast_ether_addr(psta->hwaddr))
1812554c0a3aSHans de Goede return;
1813554c0a3aSHans de Goede
1814554c0a3aSHans de Goede if (!memcmp(psta->hwaddr, myid(&padapter->eeprompriv), ETH_ALEN))
1815554c0a3aSHans de Goede return;
1816554c0a3aSHans de Goede
1817554c0a3aSHans de Goede spin_lock_bh(&pdvobj->lock);
1818554c0a3aSHans de Goede if (psta->mac_id < NUM_STA && psta->mac_id != 1) {
1819554c0a3aSHans de Goede if (pdvobj->macid[psta->mac_id] == true) {
1820554c0a3aSHans de Goede pdvobj->macid[psta->mac_id] = false;
1821554c0a3aSHans de Goede psta->mac_id = NUM_STA;
1822554c0a3aSHans de Goede }
1823554c0a3aSHans de Goede }
1824554c0a3aSHans de Goede spin_unlock_bh(&pdvobj->lock);
1825554c0a3aSHans de Goede }
182622045712SRoss Schmidt
1827554c0a3aSHans de Goede /* For 8188E RA */
rtw_search_max_mac_id(struct adapter * padapter)1828554c0a3aSHans de Goede u8 rtw_search_max_mac_id(struct adapter *padapter)
1829554c0a3aSHans de Goede {
1830554c0a3aSHans de Goede u8 max_mac_id = 0;
1831554c0a3aSHans de Goede struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter);
1832554c0a3aSHans de Goede int i;
183322045712SRoss Schmidt
1834554c0a3aSHans de Goede spin_lock_bh(&pdvobj->lock);
1835554c0a3aSHans de Goede for (i = (NUM_STA-1); i >= 0 ; i--) {
1836554c0a3aSHans de Goede if (pdvobj->macid[i] == true)
1837554c0a3aSHans de Goede break;
1838554c0a3aSHans de Goede }
1839554c0a3aSHans de Goede max_mac_id = i;
1840554c0a3aSHans de Goede spin_unlock_bh(&pdvobj->lock);
1841554c0a3aSHans de Goede
1842554c0a3aSHans de Goede return max_mac_id;
1843554c0a3aSHans de Goede }
1844554c0a3aSHans de Goede
dvobj_get_port0_adapter(struct dvobj_priv * dvobj)1845554c0a3aSHans de Goede struct adapter *dvobj_get_port0_adapter(struct dvobj_priv *dvobj)
1846554c0a3aSHans de Goede {
1847554c0a3aSHans de Goede if (get_iface_type(dvobj->padapters[i]) != IFACE_PORT0)
1848554c0a3aSHans de Goede return NULL;
1849554c0a3aSHans de Goede
1850554c0a3aSHans de Goede return dvobj->padapters;
1851554c0a3aSHans de Goede }
1852