1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
4 *
5 * Contact Information: wlanfae <wlanfae@realtek.com>
6 */
7 #include "rtllib.h"
8 #include "rtl819x_HT.h"
9 u8 MCS_FILTER_ALL[16] = {
10 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
11 0xff, 0x1f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
12 };
13
14 u8 MCS_FILTER_1SS[16] = {
15 0xff, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00,
16 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}
17 ;
18
19 u16 MCS_DATA_RATE[2][2][77] = {
20 {{13, 26, 39, 52, 78, 104, 117, 130, 26, 52, 78, 104, 156, 208, 234,
21 260, 39, 78, 117, 234, 312, 351, 390, 52, 104, 156, 208, 312, 416,
22 468, 520, 0, 78, 104, 130, 117, 156, 195, 104, 130, 130, 156, 182,
23 182, 208, 156, 195, 195, 234, 273, 273, 312, 130, 156, 181, 156,
24 181, 208, 234, 208, 234, 260, 260, 286, 195, 234, 273, 234, 273,
25 312, 351, 312, 351, 390, 390, 429},
26 {14, 29, 43, 58, 87, 116, 130, 144, 29, 58, 87, 116, 173, 231, 260, 289,
27 43, 87, 130, 173, 260, 347, 390, 433, 58, 116, 173, 231, 347, 462, 520,
28 578, 0, 87, 116, 144, 130, 173, 217, 116, 144, 144, 173, 202, 202, 231,
29 173, 217, 217, 260, 303, 303, 347, 144, 173, 202, 173, 202, 231, 260,
30 231, 260, 289, 289, 318, 217, 260, 303, 260, 303, 347, 390, 347, 390,
31 433, 433, 477} },
32 {{27, 54, 81, 108, 162, 216, 243, 270, 54, 108, 162, 216, 324, 432, 486,
33 540, 81, 162, 243, 324, 486, 648, 729, 810, 108, 216, 324, 432, 648,
34 864, 972, 1080, 12, 162, 216, 270, 243, 324, 405, 216, 270, 270, 324,
35 378, 378, 432, 324, 405, 405, 486, 567, 567, 648, 270, 324, 378, 324,
36 378, 432, 486, 432, 486, 540, 540, 594, 405, 486, 567, 486, 567, 648,
37 729, 648, 729, 810, 810, 891},
38 {30, 60, 90, 120, 180, 240, 270, 300, 60, 120, 180, 240, 360, 480, 540,
39 600, 90, 180, 270, 360, 540, 720, 810, 900, 120, 240, 360, 480, 720,
40 960, 1080, 1200, 13, 180, 240, 300, 270, 360, 450, 240, 300, 300, 360,
41 420, 420, 480, 360, 450, 450, 540, 630, 630, 720, 300, 360, 420, 360,
42 420, 480, 540, 480, 540, 600, 600, 660, 450, 540, 630, 540, 630, 720,
43 810, 720, 810, 900, 900, 990} }
44 };
45
46 static u8 UNKNOWN_BORADCOM[3] = {0x00, 0x14, 0xbf};
47
48 static u8 LINKSYSWRT330_LINKSYSWRT300_BROADCOM[3] = {0x00, 0x1a, 0x70};
49
50 static u8 LINKSYSWRT350_LINKSYSWRT150_BROADCOM[3] = {0x00, 0x1d, 0x7e};
51
52 static u8 BELKINF5D8233V1_RALINK[3] = {0x00, 0x17, 0x3f};
53
54 static u8 BELKINF5D82334V3_RALINK[3] = {0x00, 0x1c, 0xdf};
55
56 static u8 PCI_RALINK[3] = {0x00, 0x90, 0xcc};
57
58 static u8 EDIMAX_RALINK[3] = {0x00, 0x0e, 0x2e};
59
60 static u8 AIRLINK_RALINK[3] = {0x00, 0x18, 0x02};
61
62 static u8 DLINK_ATHEROS_1[3] = {0x00, 0x1c, 0xf0};
63
64 static u8 DLINK_ATHEROS_2[3] = {0x00, 0x21, 0x91};
65
66 static u8 CISCO_BROADCOM[3] = {0x00, 0x17, 0x94};
67
68 static u8 LINKSYS_MARVELL_4400N[3] = {0x00, 0x14, 0xa4};
69
HTUpdateDefaultSetting(struct rtllib_device * ieee)70 void HTUpdateDefaultSetting(struct rtllib_device *ieee)
71 {
72 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
73
74 pHTInfo->bAcceptAddbaReq = 1;
75
76 pHTInfo->bRegShortGI20MHz = 1;
77 pHTInfo->bRegShortGI40MHz = 1;
78
79 pHTInfo->bRegBW40MHz = 1;
80
81 if (pHTInfo->bRegBW40MHz)
82 pHTInfo->bRegSuppCCK = 1;
83 else
84 pHTInfo->bRegSuppCCK = true;
85
86 pHTInfo->nAMSDU_MaxSize = 7935UL;
87 pHTInfo->bAMSDU_Support = 0;
88
89 pHTInfo->bAMPDUEnable = 1;
90 pHTInfo->AMPDU_Factor = 2;
91 pHTInfo->MPDU_Density = 0;
92
93 pHTInfo->SelfMimoPs = 3;
94 if (pHTInfo->SelfMimoPs == 2)
95 pHTInfo->SelfMimoPs = 3;
96 ieee->bTxDisableRateFallBack = 0;
97 ieee->bTxUseDriverAssingedRate = 0;
98
99 ieee->bTxEnableFwCalcDur = 1;
100
101 pHTInfo->bRegRT2RTAggregation = 1;
102
103 pHTInfo->bRegRxReorderEnable = 1;
104 pHTInfo->RxReorderWinSize = 64;
105 pHTInfo->RxReorderPendingTime = 30;
106 }
107
HTMcsToDataRate(struct rtllib_device * ieee,u8 nMcsRate)108 static u16 HTMcsToDataRate(struct rtllib_device *ieee, u8 nMcsRate)
109 {
110 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
111
112 u8 is40MHz = (pHTInfo->bCurBW40MHz) ? 1 : 0;
113 u8 isShortGI = (pHTInfo->bCurBW40MHz) ?
114 ((pHTInfo->bCurShortGI40MHz) ? 1 : 0) :
115 ((pHTInfo->bCurShortGI20MHz) ? 1 : 0);
116 return MCS_DATA_RATE[is40MHz][isShortGI][(nMcsRate & 0x7f)];
117 }
118
TxCountToDataRate(struct rtllib_device * ieee,u8 nDataRate)119 u16 TxCountToDataRate(struct rtllib_device *ieee, u8 nDataRate)
120 {
121 u16 CCKOFDMRate[12] = {0x02, 0x04, 0x0b, 0x16, 0x0c, 0x12, 0x18,
122 0x24, 0x30, 0x48, 0x60, 0x6c};
123 u8 is40MHz = 0;
124 u8 isShortGI = 0;
125
126 if (nDataRate < 12)
127 return CCKOFDMRate[nDataRate];
128 if (nDataRate >= 0x10 && nDataRate <= 0x1f) {
129 is40MHz = 0;
130 isShortGI = 0;
131 } else if (nDataRate >= 0x20 && nDataRate <= 0x2f) {
132 is40MHz = 1;
133 isShortGI = 0;
134 } else if (nDataRate >= 0x30 && nDataRate <= 0x3f) {
135 is40MHz = 0;
136 isShortGI = 1;
137 } else if (nDataRate >= 0x40 && nDataRate <= 0x4f) {
138 is40MHz = 1;
139 isShortGI = 1;
140 }
141 return MCS_DATA_RATE[is40MHz][isShortGI][nDataRate & 0xf];
142 }
143
IsHTHalfNmodeAPs(struct rtllib_device * ieee)144 bool IsHTHalfNmodeAPs(struct rtllib_device *ieee)
145 {
146 bool retValue = false;
147 struct rtllib_network *net = &ieee->current_network;
148
149 if ((memcmp(net->bssid, BELKINF5D8233V1_RALINK, 3) == 0) ||
150 (memcmp(net->bssid, BELKINF5D82334V3_RALINK, 3) == 0) ||
151 (memcmp(net->bssid, PCI_RALINK, 3) == 0) ||
152 (memcmp(net->bssid, EDIMAX_RALINK, 3) == 0) ||
153 (memcmp(net->bssid, AIRLINK_RALINK, 3) == 0) ||
154 (net->ralink_cap_exist))
155 retValue = true;
156 else if (!memcmp(net->bssid, UNKNOWN_BORADCOM, 3) ||
157 !memcmp(net->bssid, LINKSYSWRT330_LINKSYSWRT300_BROADCOM, 3) ||
158 !memcmp(net->bssid, LINKSYSWRT350_LINKSYSWRT150_BROADCOM, 3) ||
159 (net->broadcom_cap_exist))
160 retValue = true;
161 else if (net->bssht.bd_rt2rt_aggregation)
162 retValue = true;
163 else
164 retValue = false;
165
166 return retValue;
167 }
168
HTIOTPeerDetermine(struct rtllib_device * ieee)169 static void HTIOTPeerDetermine(struct rtllib_device *ieee)
170 {
171 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
172 struct rtllib_network *net = &ieee->current_network;
173
174 if (net->bssht.bd_rt2rt_aggregation) {
175 pHTInfo->IOTPeer = HT_IOT_PEER_REALTEK;
176 if (net->bssht.rt2rt_ht_mode & RT_HT_CAP_USE_92SE)
177 pHTInfo->IOTPeer = HT_IOT_PEER_REALTEK_92SE;
178 if (net->bssht.rt2rt_ht_mode & RT_HT_CAP_USE_SOFTAP)
179 pHTInfo->IOTPeer = HT_IOT_PEER_92U_SOFTAP;
180 } else if (net->broadcom_cap_exist) {
181 pHTInfo->IOTPeer = HT_IOT_PEER_BROADCOM;
182 } else if (!memcmp(net->bssid, UNKNOWN_BORADCOM, 3) ||
183 !memcmp(net->bssid, LINKSYSWRT330_LINKSYSWRT300_BROADCOM, 3) ||
184 !memcmp(net->bssid, LINKSYSWRT350_LINKSYSWRT150_BROADCOM, 3)) {
185 pHTInfo->IOTPeer = HT_IOT_PEER_BROADCOM;
186 } else if ((memcmp(net->bssid, BELKINF5D8233V1_RALINK, 3) == 0) ||
187 (memcmp(net->bssid, BELKINF5D82334V3_RALINK, 3) == 0) ||
188 (memcmp(net->bssid, PCI_RALINK, 3) == 0) ||
189 (memcmp(net->bssid, EDIMAX_RALINK, 3) == 0) ||
190 (memcmp(net->bssid, AIRLINK_RALINK, 3) == 0) ||
191 net->ralink_cap_exist) {
192 pHTInfo->IOTPeer = HT_IOT_PEER_RALINK;
193 } else if ((net->atheros_cap_exist) ||
194 (memcmp(net->bssid, DLINK_ATHEROS_1, 3) == 0) ||
195 (memcmp(net->bssid, DLINK_ATHEROS_2, 3) == 0)) {
196 pHTInfo->IOTPeer = HT_IOT_PEER_ATHEROS;
197 } else if ((memcmp(net->bssid, CISCO_BROADCOM, 3) == 0) ||
198 net->cisco_cap_exist) {
199 pHTInfo->IOTPeer = HT_IOT_PEER_CISCO;
200 } else if ((memcmp(net->bssid, LINKSYS_MARVELL_4400N, 3) == 0) ||
201 net->marvell_cap_exist) {
202 pHTInfo->IOTPeer = HT_IOT_PEER_MARVELL;
203 } else if (net->airgo_cap_exist) {
204 pHTInfo->IOTPeer = HT_IOT_PEER_AIRGO;
205 } else {
206 pHTInfo->IOTPeer = HT_IOT_PEER_UNKNOWN;
207 }
208
209 netdev_dbg(ieee->dev, "IOTPEER: %x\n", pHTInfo->IOTPeer);
210 }
211
HTIOTActIsDisableMCS14(struct rtllib_device * ieee,u8 * PeerMacAddr)212 static u8 HTIOTActIsDisableMCS14(struct rtllib_device *ieee, u8 *PeerMacAddr)
213 {
214 return 0;
215 }
216
HTIOTActIsDisableMCS15(struct rtllib_device * ieee)217 static bool HTIOTActIsDisableMCS15(struct rtllib_device *ieee)
218 {
219 return false;
220 }
221
HTIOTActIsDisableMCSTwoSpatialStream(struct rtllib_device * ieee)222 static bool HTIOTActIsDisableMCSTwoSpatialStream(struct rtllib_device *ieee)
223 {
224 return false;
225 }
226
HTIOTActIsDisableEDCATurbo(struct rtllib_device * ieee,u8 * PeerMacAddr)227 static u8 HTIOTActIsDisableEDCATurbo(struct rtllib_device *ieee,
228 u8 *PeerMacAddr)
229 {
230 return false;
231 }
232
HTIOTActIsMgntUseCCK6M(struct rtllib_device * ieee,struct rtllib_network * network)233 static u8 HTIOTActIsMgntUseCCK6M(struct rtllib_device *ieee,
234 struct rtllib_network *network)
235 {
236 u8 retValue = 0;
237
238 if (ieee->pHTInfo->IOTPeer == HT_IOT_PEER_BROADCOM)
239 retValue = 1;
240
241 return retValue;
242 }
243
HTIOTActIsCCDFsync(struct rtllib_device * ieee)244 static u8 HTIOTActIsCCDFsync(struct rtllib_device *ieee)
245 {
246 u8 retValue = 0;
247
248 if (ieee->pHTInfo->IOTPeer == HT_IOT_PEER_BROADCOM)
249 retValue = 1;
250 return retValue;
251 }
252
HTIOTActDetermineRaFunc(struct rtllib_device * ieee,bool bPeerRx2ss)253 static void HTIOTActDetermineRaFunc(struct rtllib_device *ieee, bool bPeerRx2ss)
254 {
255 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
256
257 pHTInfo->IOTRaFunc &= HT_IOT_RAFUNC_DISABLE_ALL;
258
259 if (pHTInfo->IOTPeer == HT_IOT_PEER_RALINK && !bPeerRx2ss)
260 pHTInfo->IOTRaFunc |= HT_IOT_RAFUNC_PEER_1R;
261
262 if (pHTInfo->IOTAction & HT_IOT_ACT_AMSDU_ENABLE)
263 pHTInfo->IOTRaFunc |= HT_IOT_RAFUNC_TX_AMSDU;
264 }
265
HTResetIOTSetting(struct rt_hi_throughput * pHTInfo)266 void HTResetIOTSetting(struct rt_hi_throughput *pHTInfo)
267 {
268 pHTInfo->IOTAction = 0;
269 pHTInfo->IOTPeer = HT_IOT_PEER_UNKNOWN;
270 pHTInfo->IOTRaFunc = 0;
271 }
272
HTConstructCapabilityElement(struct rtllib_device * ieee,u8 * posHTCap,u8 * len,u8 IsEncrypt,bool bAssoc)273 void HTConstructCapabilityElement(struct rtllib_device *ieee, u8 *posHTCap,
274 u8 *len, u8 IsEncrypt, bool bAssoc)
275 {
276 struct rt_hi_throughput *pHT = ieee->pHTInfo;
277 struct ht_capab_ele *pCapELE = NULL;
278
279 if (!posHTCap || !pHT) {
280 netdev_warn(ieee->dev,
281 "%s(): posHTCap and pHTInfo are null\n", __func__);
282 return;
283 }
284 memset(posHTCap, 0, *len);
285
286 if ((bAssoc) && (pHT->ePeerHTSpecVer == HT_SPEC_VER_EWC)) {
287 u8 EWC11NHTCap[] = {0x00, 0x90, 0x4c, 0x33};
288
289 memcpy(posHTCap, EWC11NHTCap, sizeof(EWC11NHTCap));
290 pCapELE = (struct ht_capab_ele *)&(posHTCap[4]);
291 *len = 30 + 2;
292 } else {
293 pCapELE = (struct ht_capab_ele *)posHTCap;
294 *len = 26 + 2;
295 }
296
297 pCapELE->AdvCoding = 0;
298 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev))
299 pCapELE->ChlWidth = 0;
300 else
301 pCapELE->ChlWidth = (pHT->bRegBW40MHz ? 1 : 0);
302
303 pCapELE->MimoPwrSave = pHT->SelfMimoPs;
304 pCapELE->GreenField = 0;
305 pCapELE->ShortGI20Mhz = 1;
306 pCapELE->ShortGI40Mhz = 1;
307
308 pCapELE->TxSTBC = 1;
309 pCapELE->RxSTBC = 0;
310 pCapELE->DelayBA = 0;
311 pCapELE->MaxAMSDUSize = (MAX_RECEIVE_BUFFER_SIZE >= 7935) ? 1 : 0;
312 pCapELE->DssCCk = ((pHT->bRegBW40MHz) ? (pHT->bRegSuppCCK ? 1 : 0) : 0);
313 pCapELE->PSMP = 0;
314 pCapELE->LSigTxopProtect = 0;
315
316 netdev_dbg(ieee->dev,
317 "TX HT cap/info ele BW=%d MaxAMSDUSize:%d DssCCk:%d\n",
318 pCapELE->ChlWidth, pCapELE->MaxAMSDUSize, pCapELE->DssCCk);
319
320 if (IsEncrypt) {
321 pCapELE->MPDUDensity = 7;
322 pCapELE->MaxRxAMPDUFactor = 2;
323 } else {
324 pCapELE->MaxRxAMPDUFactor = 3;
325 pCapELE->MPDUDensity = 0;
326 }
327
328 memcpy(pCapELE->MCS, ieee->Regdot11HTOperationalRateSet, 16);
329 memset(&pCapELE->ExtHTCapInfo, 0, 2);
330 memset(pCapELE->TxBFCap, 0, 4);
331
332 pCapELE->ASCap = 0;
333
334 if (bAssoc) {
335 if (pHT->IOTAction & HT_IOT_ACT_DISABLE_MCS15)
336 pCapELE->MCS[1] &= 0x7f;
337
338 if (pHT->IOTAction & HT_IOT_ACT_DISABLE_MCS14)
339 pCapELE->MCS[1] &= 0xbf;
340
341 if (pHT->IOTAction & HT_IOT_ACT_DISABLE_ALL_2SS)
342 pCapELE->MCS[1] &= 0x00;
343
344 if (pHT->IOTAction & HT_IOT_ACT_DISABLE_RX_40MHZ_SHORT_GI)
345 pCapELE->ShortGI40Mhz = 0;
346
347 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev)) {
348 pCapELE->ChlWidth = 0;
349 pCapELE->MCS[1] = 0;
350 }
351 }
352 }
353
HTConstructInfoElement(struct rtllib_device * ieee,u8 * posHTInfo,u8 * len,u8 IsEncrypt)354 void HTConstructInfoElement(struct rtllib_device *ieee, u8 *posHTInfo,
355 u8 *len, u8 IsEncrypt)
356 {
357 struct rt_hi_throughput *pHT = ieee->pHTInfo;
358 struct ht_info_ele *pHTInfoEle = (struct ht_info_ele *)posHTInfo;
359
360 if (!posHTInfo || !pHTInfoEle) {
361 netdev_warn(ieee->dev,
362 "%s(): posHTInfo and pHTInfoEle are null\n",
363 __func__);
364 return;
365 }
366
367 memset(posHTInfo, 0, *len);
368 if ((ieee->iw_mode == IW_MODE_ADHOC) ||
369 (ieee->iw_mode == IW_MODE_MASTER)) {
370 pHTInfoEle->ControlChl = ieee->current_network.channel;
371 pHTInfoEle->ExtChlOffset = ((!pHT->bRegBW40MHz) ?
372 HT_EXTCHNL_OFFSET_NO_EXT :
373 (ieee->current_network.channel <= 6)
374 ? HT_EXTCHNL_OFFSET_UPPER :
375 HT_EXTCHNL_OFFSET_LOWER);
376 pHTInfoEle->RecommemdedTxWidth = pHT->bRegBW40MHz;
377 pHTInfoEle->RIFS = 0;
378 pHTInfoEle->PSMPAccessOnly = 0;
379 pHTInfoEle->SrvIntGranularity = 0;
380 pHTInfoEle->OptMode = pHT->CurrentOpMode;
381 pHTInfoEle->NonGFDevPresent = 0;
382 pHTInfoEle->DualBeacon = 0;
383 pHTInfoEle->SecondaryBeacon = 0;
384 pHTInfoEle->LSigTxopProtectFull = 0;
385 pHTInfoEle->PcoActive = 0;
386 pHTInfoEle->PcoPhase = 0;
387
388 memset(pHTInfoEle->BasicMSC, 0, 16);
389
390 *len = 22 + 2;
391
392 } else {
393 *len = 0;
394 }
395 }
396
HTConstructRT2RTAggElement(struct rtllib_device * ieee,u8 * posRT2RTAgg,u8 * len)397 void HTConstructRT2RTAggElement(struct rtllib_device *ieee, u8 *posRT2RTAgg,
398 u8 *len)
399 {
400 if (!posRT2RTAgg) {
401 netdev_warn(ieee->dev, "%s(): posRT2RTAgg is null\n", __func__);
402 return;
403 }
404 memset(posRT2RTAgg, 0, *len);
405 *posRT2RTAgg++ = 0x00;
406 *posRT2RTAgg++ = 0xe0;
407 *posRT2RTAgg++ = 0x4c;
408 *posRT2RTAgg++ = 0x02;
409 *posRT2RTAgg++ = 0x01;
410
411 *posRT2RTAgg = 0x30;
412
413 if (ieee->bSupportRemoteWakeUp)
414 *posRT2RTAgg |= RT_HT_CAP_USE_WOW;
415
416 *len = 6 + 2;
417 }
418
HT_PickMCSRate(struct rtllib_device * ieee,u8 * pOperateMCS)419 static u8 HT_PickMCSRate(struct rtllib_device *ieee, u8 *pOperateMCS)
420 {
421 u8 i;
422
423 if (!pOperateMCS) {
424 netdev_warn(ieee->dev, "%s(): pOperateMCS is null\n", __func__);
425 return false;
426 }
427
428 switch (ieee->mode) {
429 case IEEE_A:
430 case IEEE_B:
431 case IEEE_G:
432 for (i = 0; i <= 15; i++)
433 pOperateMCS[i] = 0;
434 break;
435 case IEEE_N_24G:
436 case IEEE_N_5G:
437 pOperateMCS[0] &= RATE_ADPT_1SS_MASK;
438 pOperateMCS[1] &= RATE_ADPT_2SS_MASK;
439 pOperateMCS[3] &= RATE_ADPT_MCS32_MASK;
440 break;
441 default:
442 break;
443 }
444
445 return true;
446 }
447
HTGetHighestMCSRate(struct rtllib_device * ieee,u8 * pMCSRateSet,u8 * pMCSFilter)448 u8 HTGetHighestMCSRate(struct rtllib_device *ieee, u8 *pMCSRateSet,
449 u8 *pMCSFilter)
450 {
451 u8 i, j;
452 u8 bitMap;
453 u8 mcsRate = 0;
454 u8 availableMcsRate[16];
455
456 if (!pMCSRateSet || !pMCSFilter) {
457 netdev_warn(ieee->dev,
458 "%s(): pMCSRateSet and pMCSFilter are null\n",
459 __func__);
460 return false;
461 }
462 for (i = 0; i < 16; i++)
463 availableMcsRate[i] = pMCSRateSet[i] & pMCSFilter[i];
464
465 for (i = 0; i < 16; i++) {
466 if (availableMcsRate[i] != 0)
467 break;
468 }
469 if (i == 16)
470 return false;
471
472 for (i = 0; i < 16; i++) {
473 if (availableMcsRate[i] != 0) {
474 bitMap = availableMcsRate[i];
475 for (j = 0; j < 8; j++) {
476 if ((bitMap % 2) != 0) {
477 if (HTMcsToDataRate(ieee, (8 * i + j)) >
478 HTMcsToDataRate(ieee, mcsRate))
479 mcsRate = 8 * i + j;
480 }
481 bitMap >>= 1;
482 }
483 }
484 }
485 return mcsRate | 0x80;
486 }
487
HTFilterMCSRate(struct rtllib_device * ieee,u8 * pSupportMCS,u8 * pOperateMCS)488 static u8 HTFilterMCSRate(struct rtllib_device *ieee, u8 *pSupportMCS,
489 u8 *pOperateMCS)
490 {
491 u8 i;
492
493 for (i = 0; i <= 15; i++)
494 pOperateMCS[i] = ieee->Regdot11TxHTOperationalRateSet[i] &
495 pSupportMCS[i];
496
497 HT_PickMCSRate(ieee, pOperateMCS);
498
499 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev))
500 pOperateMCS[1] = 0;
501
502 for (i = 2; i <= 15; i++)
503 pOperateMCS[i] = 0;
504
505 return true;
506 }
507
508 void HTSetConnectBwMode(struct rtllib_device *ieee,
509 enum ht_channel_width Bandwidth,
510 enum ht_extchnl_offset Offset);
511
HTOnAssocRsp(struct rtllib_device * ieee)512 void HTOnAssocRsp(struct rtllib_device *ieee)
513 {
514 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
515 struct ht_capab_ele *pPeerHTCap = NULL;
516 struct ht_info_ele *pPeerHTInfo = NULL;
517 u16 nMaxAMSDUSize = 0;
518 u8 *pMcsFilter = NULL;
519
520 static u8 EWC11NHTCap[] = {0x00, 0x90, 0x4c, 0x33};
521 static u8 EWC11NHTInfo[] = {0x00, 0x90, 0x4c, 0x34};
522
523 if (!pHTInfo->bCurrentHTSupport) {
524 netdev_warn(ieee->dev, "%s(): HT_DISABLE\n", __func__);
525 return;
526 }
527 netdev_dbg(ieee->dev, "%s(): HT_ENABLE\n", __func__);
528
529 if (!memcmp(pHTInfo->PeerHTCapBuf, EWC11NHTCap, sizeof(EWC11NHTCap)))
530 pPeerHTCap = (struct ht_capab_ele *)(&pHTInfo->PeerHTCapBuf[4]);
531 else
532 pPeerHTCap = (struct ht_capab_ele *)(pHTInfo->PeerHTCapBuf);
533
534 if (!memcmp(pHTInfo->PeerHTInfoBuf, EWC11NHTInfo, sizeof(EWC11NHTInfo)))
535 pPeerHTInfo = (struct ht_info_ele *)
536 (&pHTInfo->PeerHTInfoBuf[4]);
537 else
538 pPeerHTInfo = (struct ht_info_ele *)(pHTInfo->PeerHTInfoBuf);
539
540 #ifdef VERBOSE_DEBUG
541 print_hex_dump_bytes("%s: ", __func__, DUMP_PREFIX_NONE,
542 pPeerHTCap, sizeof(struct ht_capab_ele));
543 #endif
544 HTSetConnectBwMode(ieee, (enum ht_channel_width)(pPeerHTCap->ChlWidth),
545 (enum ht_extchnl_offset)(pPeerHTInfo->ExtChlOffset));
546 pHTInfo->bCurTxBW40MHz = ((pPeerHTInfo->RecommemdedTxWidth == 1) ?
547 true : false);
548
549 pHTInfo->bCurShortGI20MHz = ((pHTInfo->bRegShortGI20MHz) ?
550 ((pPeerHTCap->ShortGI20Mhz == 1) ?
551 true : false) : false);
552 pHTInfo->bCurShortGI40MHz = ((pHTInfo->bRegShortGI40MHz) ?
553 ((pPeerHTCap->ShortGI40Mhz == 1) ?
554 true : false) : false);
555
556 pHTInfo->bCurSuppCCK = ((pHTInfo->bRegSuppCCK) ?
557 ((pPeerHTCap->DssCCk == 1) ? true :
558 false) : false);
559
560 pHTInfo->bCurrent_AMSDU_Support = pHTInfo->bAMSDU_Support;
561
562 nMaxAMSDUSize = (pPeerHTCap->MaxAMSDUSize == 0) ? 3839 : 7935;
563
564 if (pHTInfo->nAMSDU_MaxSize > nMaxAMSDUSize)
565 pHTInfo->nCurrent_AMSDU_MaxSize = nMaxAMSDUSize;
566 else
567 pHTInfo->nCurrent_AMSDU_MaxSize = pHTInfo->nAMSDU_MaxSize;
568
569 pHTInfo->bCurrentAMPDUEnable = pHTInfo->bAMPDUEnable;
570 if (ieee->rtllib_ap_sec_type &&
571 (ieee->rtllib_ap_sec_type(ieee) & (SEC_ALG_WEP | SEC_ALG_TKIP))) {
572 if ((pHTInfo->IOTPeer == HT_IOT_PEER_ATHEROS) ||
573 (pHTInfo->IOTPeer == HT_IOT_PEER_UNKNOWN))
574 pHTInfo->bCurrentAMPDUEnable = false;
575 }
576
577 if (!pHTInfo->bRegRT2RTAggregation) {
578 if (pHTInfo->AMPDU_Factor > pPeerHTCap->MaxRxAMPDUFactor)
579 pHTInfo->CurrentAMPDUFactor =
580 pPeerHTCap->MaxRxAMPDUFactor;
581 else
582 pHTInfo->CurrentAMPDUFactor = pHTInfo->AMPDU_Factor;
583
584 } else {
585 if (ieee->current_network.bssht.bd_rt2rt_aggregation) {
586 if (ieee->pairwise_key_type != KEY_TYPE_NA)
587 pHTInfo->CurrentAMPDUFactor =
588 pPeerHTCap->MaxRxAMPDUFactor;
589 else
590 pHTInfo->CurrentAMPDUFactor = HT_AGG_SIZE_64K;
591 } else {
592 if (pPeerHTCap->MaxRxAMPDUFactor < HT_AGG_SIZE_32K)
593 pHTInfo->CurrentAMPDUFactor =
594 pPeerHTCap->MaxRxAMPDUFactor;
595 else
596 pHTInfo->CurrentAMPDUFactor = HT_AGG_SIZE_32K;
597 }
598 }
599 if (pHTInfo->MPDU_Density > pPeerHTCap->MPDUDensity)
600 pHTInfo->CurrentMPDUDensity = pHTInfo->MPDU_Density;
601 else
602 pHTInfo->CurrentMPDUDensity = pPeerHTCap->MPDUDensity;
603 if (pHTInfo->IOTAction & HT_IOT_ACT_TX_USE_AMSDU_8K) {
604 pHTInfo->bCurrentAMPDUEnable = false;
605 pHTInfo->ForcedAMSDUMode = HT_AGG_FORCE_ENABLE;
606 pHTInfo->ForcedAMSDUMaxSize = 7935;
607 }
608 pHTInfo->bCurRxReorderEnable = pHTInfo->bRegRxReorderEnable;
609
610 if (pPeerHTCap->MCS[0] == 0)
611 pPeerHTCap->MCS[0] = 0xff;
612
613 HTIOTActDetermineRaFunc(ieee, ((pPeerHTCap->MCS[1]) != 0));
614
615 HTFilterMCSRate(ieee, pPeerHTCap->MCS, ieee->dot11HTOperationalRateSet);
616
617 pHTInfo->PeerMimoPs = pPeerHTCap->MimoPwrSave;
618 if (pHTInfo->PeerMimoPs == MIMO_PS_STATIC)
619 pMcsFilter = MCS_FILTER_1SS;
620 else
621 pMcsFilter = MCS_FILTER_ALL;
622 ieee->HTHighestOperaRate = HTGetHighestMCSRate(ieee,
623 ieee->dot11HTOperationalRateSet, pMcsFilter);
624 ieee->HTCurrentOperaRate = ieee->HTHighestOperaRate;
625
626 pHTInfo->CurrentOpMode = pPeerHTInfo->OptMode;
627 }
628
HTInitializeHTInfo(struct rtllib_device * ieee)629 void HTInitializeHTInfo(struct rtllib_device *ieee)
630 {
631 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
632
633 pHTInfo->bCurrentHTSupport = false;
634
635 pHTInfo->bCurBW40MHz = false;
636 pHTInfo->bCurTxBW40MHz = false;
637
638 pHTInfo->bCurShortGI20MHz = false;
639 pHTInfo->bCurShortGI40MHz = false;
640 pHTInfo->bForcedShortGI = false;
641
642 pHTInfo->bCurSuppCCK = true;
643
644 pHTInfo->bCurrent_AMSDU_Support = false;
645 pHTInfo->nCurrent_AMSDU_MaxSize = pHTInfo->nAMSDU_MaxSize;
646 pHTInfo->CurrentMPDUDensity = pHTInfo->MPDU_Density;
647 pHTInfo->CurrentAMPDUFactor = pHTInfo->AMPDU_Factor;
648
649 memset((void *)(&(pHTInfo->SelfHTCap)), 0,
650 sizeof(pHTInfo->SelfHTCap));
651 memset((void *)(&(pHTInfo->SelfHTInfo)), 0,
652 sizeof(pHTInfo->SelfHTInfo));
653 memset((void *)(&(pHTInfo->PeerHTCapBuf)), 0,
654 sizeof(pHTInfo->PeerHTCapBuf));
655 memset((void *)(&(pHTInfo->PeerHTInfoBuf)), 0,
656 sizeof(pHTInfo->PeerHTInfoBuf));
657
658 pHTInfo->bSwBwInProgress = false;
659
660 pHTInfo->ePeerHTSpecVer = HT_SPEC_VER_IEEE;
661
662 pHTInfo->bCurrentRT2RTAggregation = false;
663 pHTInfo->bCurrentRT2RTLongSlotTime = false;
664 pHTInfo->RT2RT_HT_Mode = (enum rt_ht_capability)0;
665
666 pHTInfo->IOTPeer = 0;
667 pHTInfo->IOTAction = 0;
668 pHTInfo->IOTRaFunc = 0;
669
670 {
671 u8 *RegHTSuppRateSets = &(ieee->RegHTSuppRateSet[0]);
672
673 RegHTSuppRateSets[0] = 0xFF;
674 RegHTSuppRateSets[1] = 0xFF;
675 RegHTSuppRateSets[4] = 0x01;
676 }
677 }
678
HTInitializeBssDesc(struct bss_ht * pBssHT)679 void HTInitializeBssDesc(struct bss_ht *pBssHT)
680 {
681 pBssHT->bd_support_ht = false;
682 memset(pBssHT->bd_ht_cap_buf, 0, sizeof(pBssHT->bd_ht_cap_buf));
683 pBssHT->bd_ht_cap_len = 0;
684 memset(pBssHT->bd_ht_info_buf, 0, sizeof(pBssHT->bd_ht_info_buf));
685 pBssHT->bd_ht_info_len = 0;
686
687 pBssHT->bd_ht_spec_ver = HT_SPEC_VER_IEEE;
688
689 pBssHT->bd_rt2rt_aggregation = false;
690 pBssHT->bd_rt2rt_long_slot_time = false;
691 pBssHT->rt2rt_ht_mode = (enum rt_ht_capability)0;
692 }
693
HTResetSelfAndSavePeerSetting(struct rtllib_device * ieee,struct rtllib_network * pNetwork)694 void HTResetSelfAndSavePeerSetting(struct rtllib_device *ieee,
695 struct rtllib_network *pNetwork)
696 {
697 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
698 u8 bIOTAction = 0;
699
700 /* unmark bEnableHT flag here is the same reason why unmarked in
701 * function rtllib_softmac_new_net. WB 2008.09.10
702 */
703 if (pNetwork->bssht.bd_support_ht) {
704 pHTInfo->bCurrentHTSupport = true;
705 pHTInfo->ePeerHTSpecVer = pNetwork->bssht.bd_ht_spec_ver;
706
707 if (pNetwork->bssht.bd_ht_cap_len > 0 &&
708 pNetwork->bssht.bd_ht_cap_len <= sizeof(pHTInfo->PeerHTCapBuf))
709 memcpy(pHTInfo->PeerHTCapBuf,
710 pNetwork->bssht.bd_ht_cap_buf,
711 pNetwork->bssht.bd_ht_cap_len);
712
713 if (pNetwork->bssht.bd_ht_info_len > 0 &&
714 pNetwork->bssht.bd_ht_info_len <=
715 sizeof(pHTInfo->PeerHTInfoBuf))
716 memcpy(pHTInfo->PeerHTInfoBuf,
717 pNetwork->bssht.bd_ht_info_buf,
718 pNetwork->bssht.bd_ht_info_len);
719
720 if (pHTInfo->bRegRT2RTAggregation) {
721 pHTInfo->bCurrentRT2RTAggregation =
722 pNetwork->bssht.bd_rt2rt_aggregation;
723 pHTInfo->bCurrentRT2RTLongSlotTime =
724 pNetwork->bssht.bd_rt2rt_long_slot_time;
725 pHTInfo->RT2RT_HT_Mode = pNetwork->bssht.rt2rt_ht_mode;
726 } else {
727 pHTInfo->bCurrentRT2RTAggregation = false;
728 pHTInfo->bCurrentRT2RTLongSlotTime = false;
729 pHTInfo->RT2RT_HT_Mode = (enum rt_ht_capability)0;
730 }
731
732 HTIOTPeerDetermine(ieee);
733
734 pHTInfo->IOTAction = 0;
735 bIOTAction = HTIOTActIsDisableMCS14(ieee, pNetwork->bssid);
736 if (bIOTAction)
737 pHTInfo->IOTAction |= HT_IOT_ACT_DISABLE_MCS14;
738
739 bIOTAction = HTIOTActIsDisableMCS15(ieee);
740 if (bIOTAction)
741 pHTInfo->IOTAction |= HT_IOT_ACT_DISABLE_MCS15;
742
743 bIOTAction = HTIOTActIsDisableMCSTwoSpatialStream(ieee);
744 if (bIOTAction)
745 pHTInfo->IOTAction |= HT_IOT_ACT_DISABLE_ALL_2SS;
746
747 bIOTAction = HTIOTActIsDisableEDCATurbo(ieee, pNetwork->bssid);
748 if (bIOTAction)
749 pHTInfo->IOTAction |= HT_IOT_ACT_DISABLE_EDCA_TURBO;
750
751 bIOTAction = HTIOTActIsMgntUseCCK6M(ieee, pNetwork);
752 if (bIOTAction)
753 pHTInfo->IOTAction |= HT_IOT_ACT_MGNT_USE_CCK_6M;
754 bIOTAction = HTIOTActIsCCDFsync(ieee);
755 if (bIOTAction)
756 pHTInfo->IOTAction |= HT_IOT_ACT_CDD_FSYNC;
757 } else {
758 pHTInfo->bCurrentHTSupport = false;
759 pHTInfo->bCurrentRT2RTAggregation = false;
760 pHTInfo->bCurrentRT2RTLongSlotTime = false;
761 pHTInfo->RT2RT_HT_Mode = (enum rt_ht_capability)0;
762
763 pHTInfo->IOTAction = 0;
764 pHTInfo->IOTRaFunc = 0;
765 }
766 }
767
HT_update_self_and_peer_setting(struct rtllib_device * ieee,struct rtllib_network * pNetwork)768 void HT_update_self_and_peer_setting(struct rtllib_device *ieee,
769 struct rtllib_network *pNetwork)
770 {
771 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
772 struct ht_info_ele *pPeerHTInfo =
773 (struct ht_info_ele *)pNetwork->bssht.bd_ht_info_buf;
774
775 if (pHTInfo->bCurrentHTSupport) {
776 if (pNetwork->bssht.bd_ht_info_len != 0)
777 pHTInfo->CurrentOpMode = pPeerHTInfo->OptMode;
778 }
779 }
780 EXPORT_SYMBOL(HT_update_self_and_peer_setting);
781
HTUseDefaultSetting(struct rtllib_device * ieee)782 void HTUseDefaultSetting(struct rtllib_device *ieee)
783 {
784 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
785
786 if (pHTInfo->bEnableHT) {
787 pHTInfo->bCurrentHTSupport = true;
788 pHTInfo->bCurSuppCCK = pHTInfo->bRegSuppCCK;
789
790 pHTInfo->bCurBW40MHz = pHTInfo->bRegBW40MHz;
791 pHTInfo->bCurShortGI20MHz = pHTInfo->bRegShortGI20MHz;
792
793 pHTInfo->bCurShortGI40MHz = pHTInfo->bRegShortGI40MHz;
794
795 if (ieee->iw_mode == IW_MODE_ADHOC)
796 ieee->current_network.qos_data.active =
797 ieee->current_network.qos_data.supported;
798 pHTInfo->bCurrent_AMSDU_Support = pHTInfo->bAMSDU_Support;
799 pHTInfo->nCurrent_AMSDU_MaxSize = pHTInfo->nAMSDU_MaxSize;
800
801 pHTInfo->bCurrentAMPDUEnable = pHTInfo->bAMPDUEnable;
802 pHTInfo->CurrentAMPDUFactor = pHTInfo->AMPDU_Factor;
803
804 pHTInfo->CurrentMPDUDensity = pHTInfo->CurrentMPDUDensity;
805
806 HTFilterMCSRate(ieee, ieee->Regdot11TxHTOperationalRateSet,
807 ieee->dot11HTOperationalRateSet);
808 ieee->HTHighestOperaRate = HTGetHighestMCSRate(ieee,
809 ieee->dot11HTOperationalRateSet,
810 MCS_FILTER_ALL);
811 ieee->HTCurrentOperaRate = ieee->HTHighestOperaRate;
812
813 } else {
814 pHTInfo->bCurrentHTSupport = false;
815 }
816 }
817
HTCCheck(struct rtllib_device * ieee,u8 * pFrame)818 u8 HTCCheck(struct rtllib_device *ieee, u8 *pFrame)
819 {
820 if (ieee->pHTInfo->bCurrentHTSupport) {
821 if ((IsQoSDataFrame(pFrame) && Frame_Order(pFrame)) == 1) {
822 netdev_dbg(ieee->dev, "HT CONTROL FILED EXIST!!\n");
823 return true;
824 }
825 }
826 return false;
827 }
828
HTSetConnectBwModeCallback(struct rtllib_device * ieee)829 static void HTSetConnectBwModeCallback(struct rtllib_device *ieee)
830 {
831 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
832
833 if (pHTInfo->bCurBW40MHz) {
834 if (pHTInfo->CurSTAExtChnlOffset == HT_EXTCHNL_OFFSET_UPPER)
835 ieee->set_chan(ieee->dev,
836 ieee->current_network.channel + 2);
837 else if (pHTInfo->CurSTAExtChnlOffset ==
838 HT_EXTCHNL_OFFSET_LOWER)
839 ieee->set_chan(ieee->dev,
840 ieee->current_network.channel - 2);
841 else
842 ieee->set_chan(ieee->dev,
843 ieee->current_network.channel);
844
845 ieee->SetBWModeHandler(ieee->dev, HT_CHANNEL_WIDTH_20_40,
846 pHTInfo->CurSTAExtChnlOffset);
847 } else {
848 ieee->set_chan(ieee->dev, ieee->current_network.channel);
849 ieee->SetBWModeHandler(ieee->dev, HT_CHANNEL_WIDTH_20,
850 HT_EXTCHNL_OFFSET_NO_EXT);
851 }
852
853 pHTInfo->bSwBwInProgress = false;
854 }
855
HTSetConnectBwMode(struct rtllib_device * ieee,enum ht_channel_width Bandwidth,enum ht_extchnl_offset Offset)856 void HTSetConnectBwMode(struct rtllib_device *ieee,
857 enum ht_channel_width Bandwidth,
858 enum ht_extchnl_offset Offset)
859 {
860 struct rt_hi_throughput *pHTInfo = ieee->pHTInfo;
861
862 if (!pHTInfo->bRegBW40MHz)
863 return;
864
865 if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev))
866 Bandwidth = HT_CHANNEL_WIDTH_20;
867
868 if (pHTInfo->bSwBwInProgress) {
869 pr_info("%s: bSwBwInProgress!!\n", __func__);
870 return;
871 }
872 if (Bandwidth == HT_CHANNEL_WIDTH_20_40) {
873 if (ieee->current_network.channel < 2 &&
874 Offset == HT_EXTCHNL_OFFSET_LOWER)
875 Offset = HT_EXTCHNL_OFFSET_NO_EXT;
876 if (Offset == HT_EXTCHNL_OFFSET_UPPER ||
877 Offset == HT_EXTCHNL_OFFSET_LOWER) {
878 pHTInfo->bCurBW40MHz = true;
879 pHTInfo->CurSTAExtChnlOffset = Offset;
880 } else {
881 pHTInfo->bCurBW40MHz = false;
882 pHTInfo->CurSTAExtChnlOffset = HT_EXTCHNL_OFFSET_NO_EXT;
883 }
884 } else {
885 pHTInfo->bCurBW40MHz = false;
886 pHTInfo->CurSTAExtChnlOffset = HT_EXTCHNL_OFFSET_NO_EXT;
887 }
888
889 netdev_dbg(ieee->dev, "%s():pHTInfo->bCurBW40MHz:%x\n", __func__,
890 pHTInfo->bCurBW40MHz);
891
892 pHTInfo->bSwBwInProgress = true;
893
894 HTSetConnectBwModeCallback(ieee);
895 }
896