?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Staging: rt2870: Don't call sprintf() with overlapping input and output.
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / staging / rt2870 / sta_ioctl.c
blob04cf5e5732c80dd32cb561db35e1eccb4ab3ed16
1 /*
2 *************************************************************************
3 * Ralink Tech Inc.
4 * 5F., No.36, Taiyuan St., Jhubei City,
5 * Hsinchu County 302,
6 * Taiwan, R.O.C.
7 *
8 * (c) Copyright 2002-2007, Ralink Technology, Inc.
9 *
10 * This program is free software; you can redistribute it and/or modify *
11 * it under the terms of the GNU General Public License as published by *
12 * the Free Software Foundation; either version 2 of the License, or *
13 * (at your option) any later version. *
14 * *
15 * This program is distributed in the hope that it will be useful, *
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
18 * GNU General Public License for more details. *
19 * *
20 * You should have received a copy of the GNU General Public License *
21 * along with this program; if not, write to the *
22 * Free Software Foundation, Inc., *
23 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
24 * *
25 *************************************************************************
26
27 Module Name:
28 sta_ioctl.c
29
30 Abstract:
31 IOCTL related subroutines
32
33 Revision History:
34 Who When What
35 -------- ---------- ----------------------------------------------
36 Rory Chen 01-03-2003 created
37 Rory Chen 02-14-2005 modify to support RT61
38 */
39
40 #include "rt_config.h"
41
42 #ifdef DBG
43 extern ULONG RTDebugLevel;
44 #endif
45
46 #define NR_WEP_KEYS 4
47 #define WEP_SMALL_KEY_LEN (40/8)
48 #define WEP_LARGE_KEY_LEN (104/8)
49
50 #define GROUP_KEY_NO 4
51
52 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27)
53 #define IWE_STREAM_ADD_EVENT(_A, _B, _C, _D, _E) iwe_stream_add_event(_A, _B, _C, _D, _E)
54 #define IWE_STREAM_ADD_POINT(_A, _B, _C, _D, _E) iwe_stream_add_point(_A, _B, _C, _D, _E)
55 #define IWE_STREAM_ADD_VALUE(_A, _B, _C, _D, _E, _F) iwe_stream_add_value(_A, _B, _C, _D, _E, _F)
56 #else
57 #define IWE_STREAM_ADD_EVENT(_A, _B, _C, _D, _E) iwe_stream_add_event(_B, _C, _D, _E)
58 #define IWE_STREAM_ADD_POINT(_A, _B, _C, _D, _E) iwe_stream_add_point(_B, _C, _D, _E)
59 #define IWE_STREAM_ADD_VALUE(_A, _B, _C, _D, _E, _F) iwe_stream_add_value(_B, _C, _D, _E, _F)
60 #endif
61
62 extern UCHAR CipherWpa2Template[];
63 extern UCHAR CipherWpaPskTkip[];
64 extern UCHAR CipherWpaPskTkipLen;
65
66 typedef struct PACKED _RT_VERSION_INFO{
67 UCHAR DriverVersionW;
68 UCHAR DriverVersionX;
69 UCHAR DriverVersionY;
70 UCHAR DriverVersionZ;
71 UINT DriverBuildYear;
72 UINT DriverBuildMonth;
73 UINT DriverBuildDay;
74 } RT_VERSION_INFO, *PRT_VERSION_INFO;
75
76 struct iw_priv_args privtab[] = {
77 { RTPRIV_IOCTL_SET,
78 IW_PRIV_TYPE_CHAR | 1024, 0,
79 "set"},
80
81 { RTPRIV_IOCTL_SHOW, 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK,
82 ""},
83 { RTPRIV_IOCTL_SHOW, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK,
84 ""},
85 /* --- sub-ioctls definitions --- */
86 { SHOW_CONN_STATUS,
87 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "connStatus" },
88 { SHOW_DRVIER_VERION,
89 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "driverVer" },
90 { SHOW_BA_INFO,
91 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "bainfo" },
92 { SHOW_DESC_INFO,
93 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "descinfo" },
94 { RAIO_OFF,
95 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "radio_off" },
96 { RAIO_ON,
97 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "radio_on" },
98 #ifdef QOS_DLS_SUPPORT
99 { SHOW_DLS_ENTRY_INFO,
100 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "dlsentryinfo" },
101 #endif // QOS_DLS_SUPPORT //
102 { SHOW_CFG_VALUE,
103 IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "show" },
104 { SHOW_ADHOC_ENTRY_INFO,
105 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "adhocEntry" },
106
107 /* --- sub-ioctls relations --- */
108
109 #ifdef DBG
110 { RTPRIV_IOCTL_BBP,
111 IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK,
112 "bbp"},
113 { RTPRIV_IOCTL_MAC,
114 IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024,
115 "mac"},
116 { RTPRIV_IOCTL_E2P,
117 IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024,
118 "e2p"},
119 #endif /* DBG */
120
121 { RTPRIV_IOCTL_STATISTICS,
122 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK,
123 "stat"},
124 { RTPRIV_IOCTL_GSITESURVEY,
125 0, IW_PRIV_TYPE_CHAR | 1024,
126 "get_site_survey"},
127 };
128
129 INT Set_SSID_Proc(
130 IN PRTMP_ADAPTER pAdapter,
131 IN PUCHAR arg);
132
133 #ifdef WMM_SUPPORT
134 INT Set_WmmCapable_Proc(
135 IN PRTMP_ADAPTER pAd,
136 IN PUCHAR arg);
137 #endif
138
139 INT Set_NetworkType_Proc(
140 IN PRTMP_ADAPTER pAdapter,
141 IN PUCHAR arg);
142
143 INT Set_AuthMode_Proc(
144 IN PRTMP_ADAPTER pAdapter,
145 IN PUCHAR arg);
146
147 INT Set_EncrypType_Proc(
148 IN PRTMP_ADAPTER pAdapter,
149 IN PUCHAR arg);
150
151 INT Set_DefaultKeyID_Proc(
152 IN PRTMP_ADAPTER pAdapter,
153 IN PUCHAR arg);
154
155 INT Set_Key1_Proc(
156 IN PRTMP_ADAPTER pAdapter,
157 IN PUCHAR arg);
158
159 INT Set_Key2_Proc(
160 IN PRTMP_ADAPTER pAdapter,
161 IN PUCHAR arg);
162
163 INT Set_Key3_Proc(
164 IN PRTMP_ADAPTER pAdapter,
165 IN PUCHAR arg);
166
167 INT Set_Key4_Proc(
168 IN PRTMP_ADAPTER pAdapter,
169 IN PUCHAR arg);
170
171 INT Set_WPAPSK_Proc(
172 IN PRTMP_ADAPTER pAdapter,
173 IN PUCHAR arg);
174
175
176 INT Set_PSMode_Proc(
177 IN PRTMP_ADAPTER pAdapter,
178 IN PUCHAR arg);
179
180 #ifdef WPA_SUPPLICANT_SUPPORT
181 INT Set_Wpa_Support(
182 IN PRTMP_ADAPTER pAd,
183 IN PUCHAR arg);
184 #endif // WPA_SUPPLICANT_SUPPORT //
185
186 #ifdef DBG
187 VOID RTMPIoctlBBP(
188 IN PRTMP_ADAPTER pAdapter,
189 IN struct iwreq *wrq);
190
191 VOID RTMPIoctlMAC(
192 IN PRTMP_ADAPTER pAdapter,
193 IN struct iwreq *wrq);
194
195 VOID RTMPIoctlE2PROM(
196 IN PRTMP_ADAPTER pAdapter,
197 IN struct iwreq *wrq);
198 #endif // DBG //
199
200
201 NDIS_STATUS RTMPWPANoneAddKeyProc(
202 IN PRTMP_ADAPTER pAd,
203 IN PVOID pBuf);
204
205 INT Set_FragTest_Proc(
206 IN PRTMP_ADAPTER pAdapter,
207 IN PUCHAR arg);
208
209 #ifdef DOT11_N_SUPPORT
210 INT Set_TGnWifiTest_Proc(
211 IN PRTMP_ADAPTER pAd,
212 IN PUCHAR arg);
213 #endif // DOT11_N_SUPPORT //
214
215 INT Set_LongRetryLimit_Proc(
216 IN PRTMP_ADAPTER pAdapter,
217 IN PUCHAR arg);
218
219 INT Set_ShortRetryLimit_Proc(
220 IN PRTMP_ADAPTER pAdapter,
221 IN PUCHAR arg);
222
223 #ifdef EXT_BUILD_CHANNEL_LIST
224 INT Set_Ieee80211dClientMode_Proc(
225 IN PRTMP_ADAPTER pAdapter,
226 IN PUCHAR arg);
227 #endif // EXT_BUILD_CHANNEL_LIST //
228
229 #ifdef CARRIER_DETECTION_SUPPORT
230 INT Set_CarrierDetect_Proc(
231 IN PRTMP_ADAPTER pAd,
232 IN PUCHAR arg);
233 #endif // CARRIER_DETECTION_SUPPORT //
234
235 INT Show_Adhoc_MacTable_Proc(
236 IN PRTMP_ADAPTER pAd,
237 IN PCHAR extra);
238
239 static struct {
240 CHAR *name;
241 INT (*set_proc)(PRTMP_ADAPTER pAdapter, PUCHAR arg);
242 } *PRTMP_PRIVATE_SET_PROC, RTMP_PRIVATE_SUPPORT_PROC[] = {
243 {"DriverVersion", Set_DriverVersion_Proc},
244 {"CountryRegion", Set_CountryRegion_Proc},
245 {"CountryRegionABand", Set_CountryRegionABand_Proc},
246 {"SSID", Set_SSID_Proc},
247 {"WirelessMode", Set_WirelessMode_Proc},
248 {"TxBurst", Set_TxBurst_Proc},
249 {"TxPreamble", Set_TxPreamble_Proc},
250 {"TxPower", Set_TxPower_Proc},
251 {"Channel", Set_Channel_Proc},
252 {"BGProtection", Set_BGProtection_Proc},
253 {"RTSThreshold", Set_RTSThreshold_Proc},
254 {"FragThreshold", Set_FragThreshold_Proc},
255 #ifdef DOT11_N_SUPPORT
256 {"HtBw", Set_HtBw_Proc},
257 {"HtMcs", Set_HtMcs_Proc},
258 {"HtGi", Set_HtGi_Proc},
259 {"HtOpMode", Set_HtOpMode_Proc},
260 {"HtExtcha", Set_HtExtcha_Proc},
261 {"HtMpduDensity", Set_HtMpduDensity_Proc},
262 {"HtBaWinSize", Set_HtBaWinSize_Proc},
263 {"HtRdg", Set_HtRdg_Proc},
264 {"HtAmsdu", Set_HtAmsdu_Proc},
265 {"HtAutoBa", Set_HtAutoBa_Proc},
266 {"HtBaDecline", Set_BADecline_Proc},
267 {"HtProtect", Set_HtProtect_Proc},
268 {"HtMimoPs", Set_HtMimoPs_Proc},
269 #endif // DOT11_N_SUPPORT //
270
271 #ifdef AGGREGATION_SUPPORT
272 {"PktAggregate", Set_PktAggregate_Proc},
273 #endif
274
275 #ifdef WMM_SUPPORT
276 {"WmmCapable", Set_WmmCapable_Proc},
277 #endif
278 {"IEEE80211H", Set_IEEE80211H_Proc},
279 {"NetworkType", Set_NetworkType_Proc},
280 {"AuthMode", Set_AuthMode_Proc},
281 {"EncrypType", Set_EncrypType_Proc},
282 {"DefaultKeyID", Set_DefaultKeyID_Proc},
283 {"Key1", Set_Key1_Proc},
284 {"Key2", Set_Key2_Proc},
285 {"Key3", Set_Key3_Proc},
286 {"Key4", Set_Key4_Proc},
287 {"WPAPSK", Set_WPAPSK_Proc},
288 {"ResetCounter", Set_ResetStatCounter_Proc},
289 {"PSMode", Set_PSMode_Proc},
290 #ifdef DBG
291 {"Debug", Set_Debug_Proc},
292 #endif
293
294 #ifdef RALINK_ATE
295 {"ATE", Set_ATE_Proc},
296 {"ATEDA", Set_ATE_DA_Proc},
297 {"ATESA", Set_ATE_SA_Proc},
298 {"ATEBSSID", Set_ATE_BSSID_Proc},
299 {"ATECHANNEL", Set_ATE_CHANNEL_Proc},
300 {"ATETXPOW0", Set_ATE_TX_POWER0_Proc},
301 {"ATETXPOW1", Set_ATE_TX_POWER1_Proc},
302 {"ATETXANT", Set_ATE_TX_Antenna_Proc},
303 {"ATERXANT", Set_ATE_RX_Antenna_Proc},
304 {"ATETXFREQOFFSET", Set_ATE_TX_FREQOFFSET_Proc},
305 {"ATETXBW", Set_ATE_TX_BW_Proc},
306 {"ATETXLEN", Set_ATE_TX_LENGTH_Proc},
307 {"ATETXCNT", Set_ATE_TX_COUNT_Proc},
308 {"ATETXMCS", Set_ATE_TX_MCS_Proc},
309 {"ATETXMODE", Set_ATE_TX_MODE_Proc},
310 {"ATETXGI", Set_ATE_TX_GI_Proc},
311 {"ATERXFER", Set_ATE_RX_FER_Proc},
312 {"ATERRF", Set_ATE_Read_RF_Proc},
313 {"ATEWRF1", Set_ATE_Write_RF1_Proc},
314 {"ATEWRF2", Set_ATE_Write_RF2_Proc},
315 {"ATEWRF3", Set_ATE_Write_RF3_Proc},
316 {"ATEWRF4", Set_ATE_Write_RF4_Proc},
317 {"ATELDE2P", Set_ATE_Load_E2P_Proc},
318 {"ATERE2P", Set_ATE_Read_E2P_Proc},
319 {"ATESHOW", Set_ATE_Show_Proc},
320 {"ATEHELP", Set_ATE_Help_Proc},
321
322 #ifdef RALINK_28xx_QA
323 {"TxStop", Set_TxStop_Proc},
324 {"RxStop", Set_RxStop_Proc},
325 #endif // RALINK_28xx_QA //
326 #endif // RALINK_ATE //
327
328 #ifdef WPA_SUPPLICANT_SUPPORT
329 {"WpaSupport", Set_Wpa_Support},
330 #endif // WPA_SUPPLICANT_SUPPORT //
331
332
333
334 {"FixedTxMode", Set_FixedTxMode_Proc},
335 #ifdef CONFIG_APSTA_MIXED_SUPPORT
336 {"OpMode", Set_OpMode_Proc},
337 #endif // CONFIG_APSTA_MIXED_SUPPORT //
338 #ifdef DOT11_N_SUPPORT
339 {"TGnWifiTest", Set_TGnWifiTest_Proc},
340 {"ForceGF", Set_ForceGF_Proc},
341 #endif // DOT11_N_SUPPORT //
342 #ifdef QOS_DLS_SUPPORT
343 {"DlsAddEntry", Set_DlsAddEntry_Proc},
344 {"DlsTearDownEntry", Set_DlsTearDownEntry_Proc},
345 #endif // QOS_DLS_SUPPORT //
346 {"LongRetry", Set_LongRetryLimit_Proc},
347 {"ShortRetry", Set_ShortRetryLimit_Proc},
348 #ifdef EXT_BUILD_CHANNEL_LIST
349 {"11dClientMode", Set_Ieee80211dClientMode_Proc},
350 #endif // EXT_BUILD_CHANNEL_LIST //
351 #ifdef CARRIER_DETECTION_SUPPORT
352 {"CarrierDetect", Set_CarrierDetect_Proc},
353 #endif // CARRIER_DETECTION_SUPPORT //
354
355 {NULL,}
356 };
357
358
359 VOID RTMPAddKey(
360 IN PRTMP_ADAPTER pAd,
361 IN PNDIS_802_11_KEY pKey)
362 {
363 ULONG KeyIdx;
364 MAC_TABLE_ENTRY *pEntry;
365
366 DBGPRINT(RT_DEBUG_TRACE, ("RTMPAddKey ------>\n"));
367
368 if (pAd->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
369 {
370 if (pKey->KeyIndex & 0x80000000)
371 {
372 if (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPANone)
373 {
374 NdisZeroMemory(pAd->StaCfg.PMK, 32);
375 NdisMoveMemory(pAd->StaCfg.PMK, pKey->KeyMaterial, pKey->KeyLength);
376 goto end;
377 }
378 // Update PTK
379 NdisZeroMemory(&pAd->SharedKey[BSS0][0], sizeof(CIPHER_KEY));
380 pAd->SharedKey[BSS0][0].KeyLen = LEN_TKIP_EK;
381 NdisMoveMemory(pAd->SharedKey[BSS0][0].Key, pKey->KeyMaterial, LEN_TKIP_EK);
382 #ifdef WPA_SUPPLICANT_SUPPORT
383 if (pAd->StaCfg.PairCipher == Ndis802_11Encryption2Enabled)
384 {
385 NdisMoveMemory(pAd->SharedKey[BSS0][0].RxMic, pKey->KeyMaterial + LEN_TKIP_EK, LEN_TKIP_TXMICK);
386 NdisMoveMemory(pAd->SharedKey[BSS0][0].TxMic, pKey->KeyMaterial + LEN_TKIP_EK + LEN_TKIP_TXMICK, LEN_TKIP_RXMICK);
387 }
388 else
389 #endif // WPA_SUPPLICANT_SUPPORT //
390 {
391 NdisMoveMemory(pAd->SharedKey[BSS0][0].TxMic, pKey->KeyMaterial + LEN_TKIP_EK, LEN_TKIP_TXMICK);
392 NdisMoveMemory(pAd->SharedKey[BSS0][0].RxMic, pKey->KeyMaterial + LEN_TKIP_EK + LEN_TKIP_TXMICK, LEN_TKIP_RXMICK);
393 }
394
395 // Decide its ChiperAlg
396 if (pAd->StaCfg.PairCipher == Ndis802_11Encryption2Enabled)
397 pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_TKIP;
398 else if (pAd->StaCfg.PairCipher == Ndis802_11Encryption3Enabled)
399 pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_AES;
400 else
401 pAd->SharedKey[BSS0][0].CipherAlg = CIPHER_NONE;
402
403 // Update these related information to MAC_TABLE_ENTRY
404 pEntry = &pAd->MacTab.Content[BSSID_WCID];
405 NdisMoveMemory(pEntry->PairwiseKey.Key, pAd->SharedKey[BSS0][0].Key, LEN_TKIP_EK);
406 NdisMoveMemory(pEntry->PairwiseKey.RxMic, pAd->SharedKey[BSS0][0].RxMic, LEN_TKIP_RXMICK);
407 NdisMoveMemory(pEntry->PairwiseKey.TxMic, pAd->SharedKey[BSS0][0].TxMic, LEN_TKIP_TXMICK);
408 pEntry->PairwiseKey.CipherAlg = pAd->SharedKey[BSS0][0].CipherAlg;
409
410 // Update pairwise key information to ASIC Shared Key Table
411 AsicAddSharedKeyEntry(pAd,
412 BSS0,
413 0,
414 pAd->SharedKey[BSS0][0].CipherAlg,
415 pAd->SharedKey[BSS0][0].Key,
416 pAd->SharedKey[BSS0][0].TxMic,
417 pAd->SharedKey[BSS0][0].RxMic);
418
419 // Update ASIC WCID attribute table and IVEIV table
420 RTMPAddWcidAttributeEntry(pAd,
421 BSS0,
422 0,
423 pAd->SharedKey[BSS0][0].CipherAlg,
424 pEntry);
425
426 if (pAd->StaCfg.AuthMode >= Ndis802_11AuthModeWPA2)
427 {
428 // set 802.1x port control
429 //pAd->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
430 STA_PORT_SECURED(pAd);
431
432 // Indicate Connected for GUI
433 pAd->IndicateMediaState = NdisMediaStateConnected;
434 }
435 }
436 else
437 {
438 // Update GTK
439 pAd->StaCfg.DefaultKeyId = (pKey->KeyIndex & 0xFF);
440 NdisZeroMemory(&pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId], sizeof(CIPHER_KEY));
441 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].KeyLen = LEN_TKIP_EK;
442 NdisMoveMemory(pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].Key, pKey->KeyMaterial, LEN_TKIP_EK);
443 #ifdef WPA_SUPPLICANT_SUPPORT
444 if (pAd->StaCfg.GroupCipher == Ndis802_11Encryption2Enabled)
445 {
446 NdisMoveMemory(pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].RxMic, pKey->KeyMaterial + LEN_TKIP_EK, LEN_TKIP_TXMICK);
447 NdisMoveMemory(pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].TxMic, pKey->KeyMaterial + LEN_TKIP_EK + LEN_TKIP_TXMICK, LEN_TKIP_RXMICK);
448 }
449 else
450 #endif // WPA_SUPPLICANT_SUPPORT //
451 {
452 NdisMoveMemory(pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].TxMic, pKey->KeyMaterial + LEN_TKIP_EK, LEN_TKIP_TXMICK);
453 NdisMoveMemory(pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].RxMic, pKey->KeyMaterial + LEN_TKIP_EK + LEN_TKIP_TXMICK, LEN_TKIP_RXMICK);
454 }
455
456 // Update Shared Key CipherAlg
457 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].CipherAlg = CIPHER_NONE;
458 if (pAd->StaCfg.GroupCipher == Ndis802_11Encryption2Enabled)
459 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].CipherAlg = CIPHER_TKIP;
460 else if (pAd->StaCfg.GroupCipher == Ndis802_11Encryption3Enabled)
461 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].CipherAlg = CIPHER_AES;
462
463 // Update group key information to ASIC Shared Key Table
464 AsicAddSharedKeyEntry(pAd,
465 BSS0,
466 pAd->StaCfg.DefaultKeyId,
467 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].CipherAlg,
468 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].Key,
469 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].TxMic,
470 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].RxMic);
471
472 // Update ASIC WCID attribute table and IVEIV table
473 RTMPAddWcidAttributeEntry(pAd,
474 BSS0,
475 pAd->StaCfg.DefaultKeyId,
476 pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].CipherAlg,
477 NULL);
478
479 // set 802.1x port control
480 //pAd->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
481 STA_PORT_SECURED(pAd);
482
483 // Indicate Connected for GUI
484 pAd->IndicateMediaState = NdisMediaStateConnected;
485 }
486 }
487 else // dynamic WEP from wpa_supplicant
488 {
489 UCHAR CipherAlg;
490 PUCHAR Key;
491
492 if(pKey->KeyLength == 32)
493 goto end;
494
495 KeyIdx = pKey->KeyIndex & 0x0fffffff;
496
497 if (KeyIdx < 4)
498 {
499 // it is a default shared key, for Pairwise key setting
500 if (pKey->KeyIndex & 0x80000000)
501 {
502 pEntry = MacTableLookup(pAd, pKey->BSSID);
503
504 if (pEntry)
505 {
506 DBGPRINT(RT_DEBUG_TRACE, ("RTMPAddKey: Set Pair-wise Key\n"));
507
508 // set key material and key length
509 pEntry->PairwiseKey.KeyLen = (UCHAR)pKey->KeyLength;
510 NdisMoveMemory(pEntry->PairwiseKey.Key, &pKey->KeyMaterial, pKey->KeyLength);
511
512 // set Cipher type
513 if (pKey->KeyLength == 5)
514 pEntry->PairwiseKey.CipherAlg = CIPHER_WEP64;
515 else
516 pEntry->PairwiseKey.CipherAlg = CIPHER_WEP128;
517
518 // Add Pair-wise key to Asic
519 AsicAddPairwiseKeyEntry(
520 pAd,
521 pEntry->Addr,
522 (UCHAR)pEntry->Aid,
523 &pEntry->PairwiseKey);
524
525 // update WCID attribute table and IVEIV table for this entry
526 RTMPAddWcidAttributeEntry(
527 pAd,
528 BSS0,
529 KeyIdx, // The value may be not zero
530 pEntry->PairwiseKey.CipherAlg,
531 pEntry);
532
533 }
534 }
535 else
536 {
537 // Default key for tx (shared key)
538 pAd->StaCfg.DefaultKeyId = (UCHAR) KeyIdx;
539
540 // set key material and key length
541 pAd->SharedKey[BSS0][KeyIdx].KeyLen = (UCHAR) pKey->KeyLength;
542 NdisMoveMemory(pAd->SharedKey[BSS0][KeyIdx].Key, &pKey->KeyMaterial, pKey->KeyLength);
543
544 // Set Ciper type
545 if (pKey->KeyLength == 5)
546 pAd->SharedKey[BSS0][KeyIdx].CipherAlg = CIPHER_WEP64;
547 else
548 pAd->SharedKey[BSS0][KeyIdx].CipherAlg = CIPHER_WEP128;
549
550 CipherAlg = pAd->SharedKey[BSS0][KeyIdx].CipherAlg;
551 Key = pAd->SharedKey[BSS0][KeyIdx].Key;
552
553 // Set Group key material to Asic
554 AsicAddSharedKeyEntry(pAd, BSS0, KeyIdx, CipherAlg, Key, NULL, NULL);
555
556 // Update WCID attribute table and IVEIV table for this group key table
557 RTMPAddWcidAttributeEntry(pAd, BSS0, KeyIdx, CipherAlg, NULL);
558
559 }
560 }
561 }
562 end:
563 return;
564 }
565
566 char * rtstrchr(const char * s, int c)
567 {
568 for(; *s != (char) c; ++s)
569 if (*s == '\0')
570 return NULL;
571 return (char *) s;
572 }
573
574 /*
575 This is required for LinEX2004/kernel2.6.7 to provide iwlist scanning function
576 */
577
578 int
579 rt_ioctl_giwname(struct net_device *dev,
580 struct iw_request_info *info,
581 char *name, char *extra)
582 {
583 // PRTMP_ADAPTER pAdapter = dev->ml_priv;
584
585 #ifdef RT2870
586 strncpy(name, "RT2870 Wireless", IFNAMSIZ);
587 #endif // RT2870 //
588 return 0;
589 }
590
591 int rt_ioctl_siwfreq(struct net_device *dev,
592 struct iw_request_info *info,
593 struct iw_freq *freq, char *extra)
594 {
595 PRTMP_ADAPTER pAdapter = dev->ml_priv;
596 int chan = -1;
597
598 //check if the interface is down
599 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
600 {
601 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
602 return -ENETDOWN;
603 }
604
605
606 if (freq->e > 1)
607 return -EINVAL;
608
609 if((freq->e == 0) && (freq->m <= 1000))
610 chan = freq->m; // Setting by channel number
611 else
612 MAP_KHZ_TO_CHANNEL_ID( (freq->m /100) , chan); // Setting by frequency - search the table , like 2.412G, 2.422G,
613
614 if (ChannelSanity(pAdapter, chan) == TRUE)
615 {
616 pAdapter->CommonCfg.Channel = chan;
617 DBGPRINT(RT_DEBUG_ERROR, ("==>rt_ioctl_siwfreq::SIOCSIWFREQ[cmd=0x%x] (Channel=%d)\n", SIOCSIWFREQ, pAdapter->CommonCfg.Channel));
618 }
619 else
620 return -EINVAL;
621
622 return 0;
623 }
624 int rt_ioctl_giwfreq(struct net_device *dev,
625 struct iw_request_info *info,
626 struct iw_freq *freq, char *extra)
627 {
628 VIRTUAL_ADAPTER *pVirtualAd = NULL;
629 PRTMP_ADAPTER pAdapter = NULL;
630 UCHAR ch;
631 ULONG m;
632
633 if (dev->priv_flags == INT_MAIN)
634 {
635 pAdapter = dev->ml_priv;
636 }
637 else
638 {
639 pVirtualAd = dev->ml_priv;
640 if (pVirtualAd && pVirtualAd->RtmpDev)
641 pAdapter = pVirtualAd->RtmpDev->ml_priv;
642 }
643
644 if (pAdapter == NULL)
645 {
646 /* if 1st open fail, pAd will be free;
647 So the net_dev->ml_priv will be NULL in 2rd open */
648 return -ENETDOWN;
649 }
650
651 ch = pAdapter->CommonCfg.Channel;
652
653 DBGPRINT(RT_DEBUG_TRACE,("==>rt_ioctl_giwfreq %d\n", ch));
654
655 MAP_CHANNEL_ID_TO_KHZ(ch, m);
656 freq->m = m * 100;
657 freq->e = 1;
658 return 0;
659 }
660
661 int rt_ioctl_siwmode(struct net_device *dev,
662 struct iw_request_info *info,
663 __u32 *mode, char *extra)
664 {
665 PRTMP_ADAPTER pAdapter = dev->ml_priv;
666
667 //check if the interface is down
668 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
669 {
670 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
671 return -ENETDOWN;
672 }
673
674 switch (*mode)
675 {
676 case IW_MODE_ADHOC:
677 Set_NetworkType_Proc(pAdapter, "Adhoc");
678 break;
679 case IW_MODE_INFRA:
680 Set_NetworkType_Proc(pAdapter, "Infra");
681 break;
682 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,4,20))
683 case IW_MODE_MONITOR:
684 Set_NetworkType_Proc(pAdapter, "Monitor");
685 break;
686 #endif
687 default:
688 DBGPRINT(RT_DEBUG_TRACE, ("===>rt_ioctl_siwmode::SIOCSIWMODE (unknown %d)\n", *mode));
689 return -EINVAL;
690 }
691
692 // Reset Ralink supplicant to not use, it will be set to start when UI set PMK key
693 pAdapter->StaCfg.WpaState = SS_NOTUSE;
694
695 return 0;
696 }
697
698 int rt_ioctl_giwmode(struct net_device *dev,
699 struct iw_request_info *info,
700 __u32 *mode, char *extra)
701 {
702 PRTMP_ADAPTER pAdapter = NULL;
703 VIRTUAL_ADAPTER *pVirtualAd = NULL;
704
705 if (dev->priv_flags == INT_MAIN)
706 {
707 pAdapter = dev->ml_priv;
708 }
709 else
710 {
711 pVirtualAd = dev->ml_priv;
712 if (pVirtualAd && pVirtualAd->RtmpDev)
713 pAdapter = pVirtualAd->RtmpDev->ml_priv;
714 }
715
716 if (pAdapter == NULL)
717 {
718 /* if 1st open fail, pAd will be free;
719 So the net_dev->ml_priv will be NULL in 2rd open */
720 return -ENETDOWN;
721 }
722
723 if (ADHOC_ON(pAdapter))
724 *mode = IW_MODE_ADHOC;
725 else if (INFRA_ON(pAdapter))
726 *mode = IW_MODE_INFRA;
727 #if (LINUX_VERSION_CODE > KERNEL_VERSION(2,4,20))
728 else if (MONITOR_ON(pAdapter))
729 {
730 *mode = IW_MODE_MONITOR;
731 }
732 #endif
733 else
734 *mode = IW_MODE_AUTO;
735
736 DBGPRINT(RT_DEBUG_TRACE, ("==>rt_ioctl_giwmode(mode=%d)\n", *mode));
737 return 0;
738 }
739
740 int rt_ioctl_siwsens(struct net_device *dev,
741 struct iw_request_info *info,
742 char *name, char *extra)
743 {
744 PRTMP_ADAPTER pAdapter = dev->ml_priv;
745
746 //check if the interface is down
747 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
748 {
749 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
750 return -ENETDOWN;
751 }
752
753 return 0;
754 }
755
756 int rt_ioctl_giwsens(struct net_device *dev,
757 struct iw_request_info *info,
758 char *name, char *extra)
759 {
760 return 0;
761 }
762
763 int rt_ioctl_giwrange(struct net_device *dev,
764 struct iw_request_info *info,
765 struct iw_point *data, char *extra)
766 {
767 PRTMP_ADAPTER pAdapter = NULL;
768 VIRTUAL_ADAPTER *pVirtualAd = NULL;
769 struct iw_range *range = (struct iw_range *) extra;
770 u16 val;
771 int i;
772
773 if (dev->priv_flags == INT_MAIN)
774 {
775 pAdapter = dev->ml_priv;
776 }
777 else
778 {
779 pVirtualAd = dev->ml_priv;
780 if (pVirtualAd && pVirtualAd->RtmpDev)
781 pAdapter = pVirtualAd->RtmpDev->ml_priv;
782 }
783
784 if (pAdapter == NULL)
785 {
786 /* if 1st open fail, pAd will be free;
787 So the net_dev->ml_priv will be NULL in 2rd open */
788 return -ENETDOWN;
789 }
790
791 DBGPRINT(RT_DEBUG_TRACE ,("===>rt_ioctl_giwrange\n"));
792 data->length = sizeof(struct iw_range);
793 memset(range, 0, sizeof(struct iw_range));
794
795 range->txpower_capa = IW_TXPOW_DBM;
796
797 if (INFRA_ON(pAdapter)||ADHOC_ON(pAdapter))
798 {
799 range->min_pmp = 1 * 1024;
800 range->max_pmp = 65535 * 1024;
801 range->min_pmt = 1 * 1024;
802 range->max_pmt = 1000 * 1024;
803 range->pmp_flags = IW_POWER_PERIOD;
804 range->pmt_flags = IW_POWER_TIMEOUT;
805 range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT |
806 IW_POWER_UNICAST_R | IW_POWER_ALL_R;
807 }
808
809 range->we_version_compiled = WIRELESS_EXT;
810 range->we_version_source = 14;
811
812 range->retry_capa = IW_RETRY_LIMIT;
813 range->retry_flags = IW_RETRY_LIMIT;
814 range->min_retry = 0;
815 range->max_retry = 255;
816
817 range->num_channels = pAdapter->ChannelListNum;
818
819 val = 0;
820 for (i = 1; i <= range->num_channels; i++)
821 {
822 u32 m;
823 range->freq[val].i = pAdapter->ChannelList[i-1].Channel;
824 MAP_CHANNEL_ID_TO_KHZ(pAdapter->ChannelList[i-1].Channel, m);
825 range->freq[val].m = m * 100; /* HZ */
826
827 range->freq[val].e = 1;
828 val++;
829 if (val == IW_MAX_FREQUENCIES)
830 break;
831 }
832 range->num_frequency = val;
833
834 range->max_qual.qual = 100; /* what is correct max? This was not
835 * documented exactly. At least
836 * 69 has been observed. */
837 range->max_qual.level = 0; /* dB */
838 range->max_qual.noise = 0; /* dB */
839
840 /* What would be suitable values for "average/typical" qual? */
841 range->avg_qual.qual = 20;
842 range->avg_qual.level = -60;
843 range->avg_qual.noise = -95;
844 range->sensitivity = 3;
845
846 range->max_encoding_tokens = NR_WEP_KEYS;
847 range->num_encoding_sizes = 2;
848 range->encoding_size[0] = 5;
849 range->encoding_size[1] = 13;
850
851 range->min_rts = 0;
852 range->max_rts = 2347;
853 range->min_frag = 256;
854 range->max_frag = 2346;
855
856 #if WIRELESS_EXT > 17
857 /* IW_ENC_CAPA_* bit field */
858 range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
859 IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
860 #endif
861
862 return 0;
863 }
864
865 int rt_ioctl_siwap(struct net_device *dev,
866 struct iw_request_info *info,
867 struct sockaddr *ap_addr, char *extra)
868 {
869 PRTMP_ADAPTER pAdapter = dev->ml_priv;
870 NDIS_802_11_MAC_ADDRESS Bssid;
871
872 //check if the interface is down
873 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
874 {
875 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
876 return -ENETDOWN;
877 }
878
879 if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
880 {
881 RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
882 DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
883 }
884
885 // tell CNTL state machine to call NdisMSetInformationComplete() after completing
886 // this request, because this request is initiated by NDIS.
887 pAdapter->MlmeAux.CurrReqIsFromNdis = FALSE;
888 // Prevent to connect AP again in STAMlmePeriodicExec
889 pAdapter->MlmeAux.AutoReconnectSsidLen= 32;
890
891 memset(Bssid, 0, MAC_ADDR_LEN);
892 memcpy(Bssid, ap_addr->sa_data, MAC_ADDR_LEN);
893 MlmeEnqueue(pAdapter,
894 MLME_CNTL_STATE_MACHINE,
895 OID_802_11_BSSID,
896 sizeof(NDIS_802_11_MAC_ADDRESS),
897 (VOID *)&Bssid);
898
899 DBGPRINT(RT_DEBUG_TRACE, ("IOCTL::SIOCSIWAP %02x:%02x:%02x:%02x:%02x:%02x\n",
900 Bssid[0], Bssid[1], Bssid[2], Bssid[3], Bssid[4], Bssid[5]));
901
902 return 0;
903 }
904
905 int rt_ioctl_giwap(struct net_device *dev,
906 struct iw_request_info *info,
907 struct sockaddr *ap_addr, char *extra)
908 {
909 PRTMP_ADAPTER pAdapter = NULL;
910 VIRTUAL_ADAPTER *pVirtualAd = NULL;
911
912 if (dev->priv_flags == INT_MAIN)
913 {
914 pAdapter = dev->ml_priv;
915 }
916 else
917 {
918 pVirtualAd = dev->ml_priv;
919 if (pVirtualAd && pVirtualAd->RtmpDev)
920 pAdapter = pVirtualAd->RtmpDev->ml_priv;
921 }
922
923 if (pAdapter == NULL)
924 {
925 /* if 1st open fail, pAd will be free;
926 So the net_dev->ml_priv will be NULL in 2rd open */
927 return -ENETDOWN;
928 }
929
930 if (INFRA_ON(pAdapter) || ADHOC_ON(pAdapter))
931 {
932 ap_addr->sa_family = ARPHRD_ETHER;
933 memcpy(ap_addr->sa_data, &pAdapter->CommonCfg.Bssid, ETH_ALEN);
934 }
935 #ifdef WPA_SUPPLICANT_SUPPORT
936 // Add for RT2870
937 else if (pAdapter->StaCfg.WpaSupplicantUP != WPA_SUPPLICANT_DISABLE)
938 {
939 ap_addr->sa_family = ARPHRD_ETHER;
940 memcpy(ap_addr->sa_data, &pAdapter->MlmeAux.Bssid, ETH_ALEN);
941 }
942 #endif // WPA_SUPPLICANT_SUPPORT //
943 else
944 {
945 DBGPRINT(RT_DEBUG_TRACE, ("IOCTL::SIOCGIWAP(=EMPTY)\n"));
946 return -ENOTCONN;
947 }
948
949 return 0;
950 }
951
952 /*
953 * Units are in db above the noise floor. That means the
954 * rssi values reported in the tx/rx descriptors in the
955 * driver are the SNR expressed in db.
956 *
957 * If you assume that the noise floor is -95, which is an
958 * excellent assumption 99.5 % of the time, then you can
959 * derive the absolute signal level (i.e. -95 + rssi).
960 * There are some other slight factors to take into account
961 * depending on whether the rssi measurement is from 11b,
962 * 11g, or 11a. These differences are at most 2db and
963 * can be documented.
964 *
965 * NB: various calculations are based on the orinoco/wavelan
966 * drivers for compatibility
967 */
968 static void set_quality(PRTMP_ADAPTER pAdapter,
969 struct iw_quality *iq,
970 signed char rssi)
971 {
972 __u8 ChannelQuality;
973
974 // Normalize Rssi
975 if (rssi >= -50)
976 ChannelQuality = 100;
977 else if (rssi >= -80) // between -50 ~ -80dbm
978 ChannelQuality = (__u8)(24 + ((rssi + 80) * 26)/10);
979 else if (rssi >= -90) // between -80 ~ -90dbm
980 ChannelQuality = (__u8)((rssi + 90) * 26)/10;
981 else
982 ChannelQuality = 0;
983
984 iq->qual = (__u8)ChannelQuality;
985
986 iq->level = (__u8)(rssi);
987 iq->noise = (pAdapter->BbpWriteLatch[66] > pAdapter->BbpTuning.FalseCcaUpperThreshold) ? ((__u8)pAdapter->BbpTuning.FalseCcaUpperThreshold) : ((__u8) pAdapter->BbpWriteLatch[66]); // noise level (dBm)
988 iq->noise += 256 - 143;
989 iq->updated = pAdapter->iw_stats.qual.updated;
990 }
991
992 int rt_ioctl_iwaplist(struct net_device *dev,
993 struct iw_request_info *info,
994 struct iw_point *data, char *extra)
995 {
996 PRTMP_ADAPTER pAdapter = dev->ml_priv;
997
998 struct sockaddr addr[IW_MAX_AP];
999 struct iw_quality qual[IW_MAX_AP];
1000 int i;
1001
1002 //check if the interface is down
1003 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1004 {
1005 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1006 data->length = 0;
1007 return 0;
1008 //return -ENETDOWN;
1009 }
1010
1011 for (i = 0; i <IW_MAX_AP ; i++)
1012 {
1013 if (i >= pAdapter->ScanTab.BssNr)
1014 break;
1015 addr[i].sa_family = ARPHRD_ETHER;
1016 memcpy(addr[i].sa_data, &pAdapter->ScanTab.BssEntry[i].Bssid, MAC_ADDR_LEN);
1017 set_quality(pAdapter, &qual[i], pAdapter->ScanTab.BssEntry[i].Rssi);
1018 }
1019 data->length = i;
1020 memcpy(extra, &addr, i*sizeof(addr[0]));
1021 data->flags = 1; /* signal quality present (sort of) */
1022 memcpy(extra + i*sizeof(addr[0]), &qual, i*sizeof(qual[i]));
1023
1024 return 0;
1025 }
1026
1027 #ifdef SIOCGIWSCAN
1028 int rt_ioctl_siwscan(struct net_device *dev,
1029 struct iw_request_info *info,
1030 struct iw_point *data, char *extra)
1031 {
1032 PRTMP_ADAPTER pAdapter = dev->ml_priv;
1033
1034 ULONG Now;
1035 int Status = NDIS_STATUS_SUCCESS;
1036
1037 //check if the interface is down
1038 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1039 {
1040 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1041 return -ENETDOWN;
1042 }
1043
1044 if (MONITOR_ON(pAdapter))
1045 {
1046 DBGPRINT(RT_DEBUG_TRACE, ("!!! Driver is in Monitor Mode now !!!\n"));
1047 return -EINVAL;
1048 }
1049
1050
1051 #ifdef WPA_SUPPLICANT_SUPPORT
1052 if (pAdapter->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE)
1053 {
1054 pAdapter->StaCfg.WpaSupplicantScanCount++;
1055 }
1056 #endif // WPA_SUPPLICANT_SUPPORT //
1057
1058 pAdapter->StaCfg.bScanReqIsFromWebUI = TRUE;
1059 if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
1060 return 0;
1061 do{
1062 Now = jiffies;
1063
1064 #ifdef WPA_SUPPLICANT_SUPPORT
1065 if ((pAdapter->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE) &&
1066 (pAdapter->StaCfg.WpaSupplicantScanCount > 3))
1067 {
1068 DBGPRINT(RT_DEBUG_TRACE, ("!!! WpaSupplicantScanCount > 3\n"));
1069 Status = NDIS_STATUS_SUCCESS;
1070 break;
1071 }
1072 #endif // WPA_SUPPLICANT_SUPPORT //
1073
1074 if ((OPSTATUS_TEST_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED)) &&
1075 ((pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA) ||
1076 (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK)) &&
1077 (pAdapter->StaCfg.PortSecured == WPA_802_1X_PORT_NOT_SECURED))
1078 {
1079 DBGPRINT(RT_DEBUG_TRACE, ("!!! Link UP, Port Not Secured! ignore this set::OID_802_11_BSSID_LIST_SCAN\n"));
1080 Status = NDIS_STATUS_SUCCESS;
1081 break;
1082 }
1083
1084 if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
1085 {
1086 RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
1087 DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
1088 }
1089
1090 // tell CNTL state machine to call NdisMSetInformationComplete() after completing
1091 // this request, because this request is initiated by NDIS.
1092 pAdapter->MlmeAux.CurrReqIsFromNdis = FALSE;
1093 // Reset allowed scan retries
1094 pAdapter->StaCfg.ScanCnt = 0;
1095 pAdapter->StaCfg.LastScanTime = Now;
1096
1097 MlmeEnqueue(pAdapter,
1098 MLME_CNTL_STATE_MACHINE,
1099 OID_802_11_BSSID_LIST_SCAN,
1100 0,
1101 NULL);
1102
1103 Status = NDIS_STATUS_SUCCESS;
1104 RT28XX_MLME_HANDLER(pAdapter);
1105 }while(0);
1106 return 0;
1107 }
1108
1109 int rt_ioctl_giwscan(struct net_device *dev,
1110 struct iw_request_info *info,
1111 struct iw_point *data, char *extra)
1112 {
1113
1114 PRTMP_ADAPTER pAdapter = dev->ml_priv;
1115 int i=0;
1116 char *current_ev = extra, *previous_ev = extra;
1117 char *end_buf;
1118 char *current_val, custom[MAX_CUSTOM_LEN] = {0};
1119 #ifndef IWEVGENIE
1120 char idx;
1121 #endif // IWEVGENIE //
1122 struct iw_event iwe;
1123
1124 if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
1125 {
1126 /*
1127 * Still scanning, indicate the caller should try again.
1128 */
1129 return -EAGAIN;
1130 }
1131
1132
1133 #ifdef WPA_SUPPLICANT_SUPPORT
1134 if (pAdapter->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE)
1135 {
1136 pAdapter->StaCfg.WpaSupplicantScanCount = 0;
1137 }
1138 #endif // WPA_SUPPLICANT_SUPPORT //
1139
1140 if (pAdapter->ScanTab.BssNr == 0)
1141 {
1142 data->length = 0;
1143 return 0;
1144 }
1145
1146 #if WIRELESS_EXT >= 17
1147 if (data->length > 0)
1148 end_buf = extra + data->length;
1149 else
1150 end_buf = extra + IW_SCAN_MAX_DATA;
1151 #else
1152 end_buf = extra + IW_SCAN_MAX_DATA;
1153 #endif
1154
1155 for (i = 0; i < pAdapter->ScanTab.BssNr; i++)
1156 {
1157 if (current_ev >= end_buf)
1158 {
1159 #if WIRELESS_EXT >= 17
1160 return -E2BIG;
1161 #else
1162 break;
1163 #endif
1164 }
1165
1166 //MAC address
1167 //================================
1168 memset(&iwe, 0, sizeof(iwe));
1169 iwe.cmd = SIOCGIWAP;
1170 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
1171 memcpy(iwe.u.ap_addr.sa_data, &pAdapter->ScanTab.BssEntry[i].Bssid, ETH_ALEN);
1172
1173 previous_ev = current_ev;
1174 current_ev = IWE_STREAM_ADD_EVENT(info, current_ev,end_buf, &iwe, IW_EV_ADDR_LEN);
1175 if (current_ev == previous_ev)
1176 #if WIRELESS_EXT >= 17
1177 return -E2BIG;
1178 #else
1179 break;
1180 #endif
1181
1182 //ESSID
1183 //================================
1184 memset(&iwe, 0, sizeof(iwe));
1185 iwe.cmd = SIOCGIWESSID;
1186 iwe.u.data.length = pAdapter->ScanTab.BssEntry[i].SsidLen;
1187 iwe.u.data.flags = 1;
1188
1189 previous_ev = current_ev;
1190 current_ev = IWE_STREAM_ADD_POINT(info, current_ev,end_buf, &iwe, pAdapter->ScanTab.BssEntry[i].Ssid);
1191 if (current_ev == previous_ev)
1192 #if WIRELESS_EXT >= 17
1193 return -E2BIG;
1194 #else
1195 break;
1196 #endif
1197
1198 //Network Type
1199 //================================
1200 memset(&iwe, 0, sizeof(iwe));
1201 iwe.cmd = SIOCGIWMODE;
1202 if (pAdapter->ScanTab.BssEntry[i].BssType == Ndis802_11IBSS)
1203 {
1204 iwe.u.mode = IW_MODE_ADHOC;
1205 }
1206 else if (pAdapter->ScanTab.BssEntry[i].BssType == Ndis802_11Infrastructure)
1207 {
1208 iwe.u.mode = IW_MODE_INFRA;
1209 }
1210 else
1211 {
1212 iwe.u.mode = IW_MODE_AUTO;
1213 }
1214 iwe.len = IW_EV_UINT_LEN;
1215
1216 previous_ev = current_ev;
1217 current_ev = IWE_STREAM_ADD_EVENT(info, current_ev, end_buf, &iwe, IW_EV_UINT_LEN);
1218 if (current_ev == previous_ev)
1219 #if WIRELESS_EXT >= 17
1220 return -E2BIG;
1221 #else
1222 break;
1223 #endif
1224
1225 //Channel and Frequency
1226 //================================
1227 memset(&iwe, 0, sizeof(iwe));
1228 iwe.cmd = SIOCGIWFREQ;
1229 if (INFRA_ON(pAdapter) || ADHOC_ON(pAdapter))
1230 iwe.u.freq.m = pAdapter->ScanTab.BssEntry[i].Channel;
1231 else
1232 iwe.u.freq.m = pAdapter->ScanTab.BssEntry[i].Channel;
1233 iwe.u.freq.e = 0;
1234 iwe.u.freq.i = 0;
1235
1236 previous_ev = current_ev;
1237 current_ev = IWE_STREAM_ADD_EVENT(info, current_ev,end_buf, &iwe, IW_EV_FREQ_LEN);
1238 if (current_ev == previous_ev)
1239 #if WIRELESS_EXT >= 17
1240 return -E2BIG;
1241 #else
1242 break;
1243 #endif
1244
1245 //Add quality statistics
1246 //================================
1247 memset(&iwe, 0, sizeof(iwe));
1248 iwe.cmd = IWEVQUAL;
1249 iwe.u.qual.level = 0;
1250 iwe.u.qual.noise = 0;
1251 set_quality(pAdapter, &iwe.u.qual, pAdapter->ScanTab.BssEntry[i].Rssi);
1252 current_ev = IWE_STREAM_ADD_EVENT(info, current_ev, end_buf, &iwe, IW_EV_QUAL_LEN);
1253 if (current_ev == previous_ev)
1254 #if WIRELESS_EXT >= 17
1255 return -E2BIG;
1256 #else
1257 break;
1258 #endif
1259
1260 //Encyption key
1261 //================================
1262 memset(&iwe, 0, sizeof(iwe));
1263 iwe.cmd = SIOCGIWENCODE;
1264 if (CAP_IS_PRIVACY_ON (pAdapter->ScanTab.BssEntry[i].CapabilityInfo ))
1265 iwe.u.data.flags =IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
1266 else
1267 iwe.u.data.flags = IW_ENCODE_DISABLED;
1268
1269 previous_ev = current_ev;
1270 current_ev = IWE_STREAM_ADD_POINT(info, current_ev, end_buf,&iwe, (char *)pAdapter->SharedKey[BSS0][(iwe.u.data.flags & IW_ENCODE_INDEX)-1].Key);
1271 if (current_ev == previous_ev)
1272 #if WIRELESS_EXT >= 17
1273 return -E2BIG;
1274 #else
1275 break;
1276 #endif
1277
1278 //Bit Rate
1279 //================================
1280 if (pAdapter->ScanTab.BssEntry[i].SupRateLen)
1281 {
1282 UCHAR tmpRate = pAdapter->ScanTab.BssEntry[i].SupRate[pAdapter->ScanTab.BssEntry[i].SupRateLen-1];
1283 memset(&iwe, 0, sizeof(iwe));
1284 iwe.cmd = SIOCGIWRATE;
1285 current_val = current_ev + IW_EV_LCP_LEN;
1286 if (tmpRate == 0x82)
1287 iwe.u.bitrate.value = 1 * 1000000;
1288 else if (tmpRate == 0x84)
1289 iwe.u.bitrate.value = 2 * 1000000;
1290 else if (tmpRate == 0x8B)
1291 iwe.u.bitrate.value = 5.5 * 1000000;
1292 else if (tmpRate == 0x96)
1293 iwe.u.bitrate.value = 11 * 1000000;
1294 else
1295 iwe.u.bitrate.value = (tmpRate/2) * 1000000;
1296
1297 iwe.u.bitrate.disabled = 0;
1298 current_val = IWE_STREAM_ADD_VALUE(info, current_ev,
1299 current_val, end_buf, &iwe,
1300 IW_EV_PARAM_LEN);
1301
1302 if((current_val-current_ev)>IW_EV_LCP_LEN)
1303 current_ev = current_val;
1304 else
1305 #if WIRELESS_EXT >= 17
1306 return -E2BIG;
1307 #else
1308 break;
1309 #endif
1310 }
1311
1312 #ifdef IWEVGENIE
1313 //WPA IE
1314 if (pAdapter->ScanTab.BssEntry[i].WpaIE.IELen > 0)
1315 {
1316 memset(&iwe, 0, sizeof(iwe));
1317 memset(&custom[0], 0, MAX_CUSTOM_LEN);
1318 memcpy(custom, &(pAdapter->ScanTab.BssEntry[i].WpaIE.IE[0]),
1319 pAdapter->ScanTab.BssEntry[i].WpaIE.IELen);
1320 iwe.cmd = IWEVGENIE;
1321 iwe.u.data.length = pAdapter->ScanTab.BssEntry[i].WpaIE.IELen;
1322 current_ev = IWE_STREAM_ADD_POINT(info, current_ev, end_buf, &iwe, custom);
1323 if (current_ev == previous_ev)
1324 #if WIRELESS_EXT >= 17
1325 return -E2BIG;
1326 #else
1327 break;
1328 #endif
1329 }
1330
1331 //WPA2 IE
1332 if (pAdapter->ScanTab.BssEntry[i].RsnIE.IELen > 0)
1333 {
1334 memset(&iwe, 0, sizeof(iwe));
1335 memset(&custom[0], 0, MAX_CUSTOM_LEN);
1336 memcpy(custom, &(pAdapter->ScanTab.BssEntry[i].RsnIE.IE[0]),
1337 pAdapter->ScanTab.BssEntry[i].RsnIE.IELen);
1338 iwe.cmd = IWEVGENIE;
1339 iwe.u.data.length = pAdapter->ScanTab.BssEntry[i].RsnIE.IELen;
1340 current_ev = IWE_STREAM_ADD_POINT(info, current_ev, end_buf, &iwe, custom);
1341 if (current_ev == previous_ev)
1342 #if WIRELESS_EXT >= 17
1343 return -E2BIG;
1344 #else
1345 break;
1346 #endif
1347 }
1348 #else
1349 //WPA IE
1350 //================================
1351 if (pAdapter->ScanTab.BssEntry[i].WpaIE.IELen > 0)
1352 {
1353 NdisZeroMemory(&iwe, sizeof(iwe));
1354 memset(&custom[0], 0, MAX_CUSTOM_LEN);
1355 iwe.cmd = IWEVCUSTOM;
1356 iwe.u.data.length = (pAdapter->ScanTab.BssEntry[i].WpaIE.IELen * 2) + 7;
1357 NdisMoveMemory(custom, "wpa_ie=", 7);
1358 for (idx = 0; idx < pAdapter->ScanTab.BssEntry[i].WpaIE.IELen; idx++)
1359 sprintf(custom + strlen(custom), "%02x", pAdapter->ScanTab.BssEntry[i].WpaIE.IE[idx]);
1360 previous_ev = current_ev;
1361 current_ev = IWE_STREAM_ADD_POINT(info, current_ev, end_buf, &iwe, custom);
1362 if (current_ev == previous_ev)
1363 #if WIRELESS_EXT >= 17
1364 return -E2BIG;
1365 #else
1366 break;
1367 #endif
1368 }
1369
1370 //WPA2 IE
1371 if (pAdapter->ScanTab.BssEntry[i].RsnIE.IELen > 0)
1372 {
1373 NdisZeroMemory(&iwe, sizeof(iwe));
1374 memset(&custom[0], 0, MAX_CUSTOM_LEN);
1375 iwe.cmd = IWEVCUSTOM;
1376 iwe.u.data.length = (pAdapter->ScanTab.BssEntry[i].RsnIE.IELen * 2) + 7;
1377 NdisMoveMemory(custom, "rsn_ie=", 7);
1378 for (idx = 0; idx < pAdapter->ScanTab.BssEntry[i].RsnIE.IELen; idx++)
1379 sprintf(custom + strlen(custom), "%02x", pAdapter->ScanTab.BssEntry[i].RsnIE.IE[idx]);
1380 previous_ev = current_ev;
1381 current_ev = IWE_STREAM_ADD_POINT(info, current_ev, end_buf, &iwe, custom);
1382 if (current_ev == previous_ev)
1383 #if WIRELESS_EXT >= 17
1384 return -E2BIG;
1385 #else
1386 break;
1387 #endif
1388 }
1389 #endif // IWEVGENIE //
1390 }
1391
1392 data->length = current_ev - extra;
1393 pAdapter->StaCfg.bScanReqIsFromWebUI = FALSE;
1394 DBGPRINT(RT_DEBUG_ERROR ,("===>rt_ioctl_giwscan. %d(%d) BSS returned, data->length = %d\n",i , pAdapter->ScanTab.BssNr, data->length));
1395 return 0;
1396 }
1397 #endif
1398
1399 int rt_ioctl_siwessid(struct net_device *dev,
1400 struct iw_request_info *info,
1401 struct iw_point *data, char *essid)
1402 {
1403 PRTMP_ADAPTER pAdapter = dev->ml_priv;
1404
1405 //check if the interface is down
1406 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1407 {
1408 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1409 return -ENETDOWN;
1410 }
1411
1412 if (data->flags)
1413 {
1414 PCHAR pSsidString = NULL;
1415
1416 // Includes null character.
1417 if (data->length > (IW_ESSID_MAX_SIZE + 1))
1418 return -E2BIG;
1419
1420 pSsidString = (CHAR *) kmalloc(MAX_LEN_OF_SSID+1, MEM_ALLOC_FLAG);
1421 if (pSsidString)
1422 {
1423 NdisZeroMemory(pSsidString, MAX_LEN_OF_SSID+1);
1424 NdisMoveMemory(pSsidString, essid, data->length);
1425 if (Set_SSID_Proc(pAdapter, pSsidString) == FALSE)
1426 return -EINVAL;
1427 }
1428 else
1429 return -ENOMEM;
1430 }
1431 else
1432 {
1433 // ANY ssid
1434 if (Set_SSID_Proc(pAdapter, "") == FALSE)
1435 return -EINVAL;
1436 }
1437 return 0;
1438 }
1439
1440 int rt_ioctl_giwessid(struct net_device *dev,
1441 struct iw_request_info *info,
1442 struct iw_point *data, char *essid)
1443 {
1444 PRTMP_ADAPTER pAdapter = NULL;
1445 VIRTUAL_ADAPTER *pVirtualAd = NULL;
1446
1447 if (dev->priv_flags == INT_MAIN)
1448 {
1449 pAdapter = dev->ml_priv;
1450 }
1451 else
1452 {
1453 pVirtualAd = dev->ml_priv;
1454 if (pVirtualAd && pVirtualAd->RtmpDev)
1455 pAdapter = pVirtualAd->RtmpDev->ml_priv;
1456 }
1457
1458 if (pAdapter == NULL)
1459 {
1460 /* if 1st open fail, pAd will be free;
1461 So the net_dev->ml_priv will be NULL in 2rd open */
1462 return -ENETDOWN;
1463 }
1464
1465 data->flags = 1;
1466 if (MONITOR_ON(pAdapter))
1467 {
1468 data->length = 0;
1469 return 0;
1470 }
1471
1472 if (OPSTATUS_TEST_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED))
1473 {
1474 DBGPRINT(RT_DEBUG_TRACE ,("MediaState is connected\n"));
1475 data->length = pAdapter->CommonCfg.SsidLen;
1476 memcpy(essid, pAdapter->CommonCfg.Ssid, pAdapter->CommonCfg.SsidLen);
1477 }
1478 #ifdef RT2870
1479 #ifdef WPA_SUPPLICANT_SUPPORT
1480 // Add for RT2870
1481 else if (pAdapter->StaCfg.WpaSupplicantUP != WPA_SUPPLICANT_DISABLE)
1482 {
1483 data->length = pAdapter->CommonCfg.SsidLen;
1484 memcpy(essid, pAdapter->CommonCfg.Ssid, pAdapter->CommonCfg.SsidLen);
1485 }
1486 #endif // WPA_SUPPLICANT_SUPPORT //
1487 #endif // RT2870 //
1488 else
1489 {//the ANY ssid was specified
1490 data->length = 0;
1491 DBGPRINT(RT_DEBUG_TRACE ,("MediaState is not connected, ess\n"));
1492 }
1493
1494 return 0;
1495
1496 }
1497
1498 int rt_ioctl_siwnickn(struct net_device *dev,
1499 struct iw_request_info *info,
1500 struct iw_point *data, char *nickname)
1501 {
1502 PRTMP_ADAPTER pAdapter = dev->ml_priv;
1503
1504 //check if the interface is down
1505 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1506 {
1507 DBGPRINT(RT_DEBUG_TRACE ,("INFO::Network is down!\n"));
1508 return -ENETDOWN;
1509 }
1510
1511 if (data->length > IW_ESSID_MAX_SIZE)
1512 return -EINVAL;
1513
1514 memset(pAdapter->nickname, 0, IW_ESSID_MAX_SIZE + 1);
1515 memcpy(pAdapter->nickname, nickname, data->length);
1516
1517
1518 return 0;
1519 }
1520
1521 int rt_ioctl_giwnickn(struct net_device *dev,
1522 struct iw_request_info *info,
1523 struct iw_point *data, char *nickname)
1524 {
1525 PRTMP_ADAPTER pAdapter = NULL;
1526 VIRTUAL_ADAPTER *pVirtualAd = NULL;
1527
1528 if (dev->priv_flags == INT_MAIN)
1529 {
1530 pAdapter = dev->ml_priv;
1531 }
1532 else
1533 {
1534 pVirtualAd = dev->ml_priv;
1535 if (pVirtualAd && pVirtualAd->RtmpDev)
1536 pAdapter = pVirtualAd->RtmpDev->ml_priv;
1537 }
1538
1539 if (pAdapter == NULL)
1540 {
1541 /* if 1st open fail, pAd will be free;
1542 So the net_dev->ml_priv will be NULL in 2rd open */
1543 return -ENETDOWN;
1544 }
1545
1546 if (data->length > strlen(pAdapter->nickname) + 1)
1547 data->length = strlen(pAdapter->nickname) + 1;
1548 if (data->length > 0) {
1549 memcpy(nickname, pAdapter->nickname, data->length-1);
1550 nickname[data->length-1] = '\0';
1551 }
1552 return 0;
1553 }
1554
1555 int rt_ioctl_siwrts(struct net_device *dev,
1556 struct iw_request_info *info,
1557 struct iw_param *rts, char *extra)
1558 {
1559 PRTMP_ADAPTER pAdapter = dev->ml_priv;
1560 u16 val;
1561
1562 //check if the interface is down
1563 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1564 {
1565 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1566 return -ENETDOWN;
1567 }
1568
1569 if (rts->disabled)
1570 val = MAX_RTS_THRESHOLD;
1571 else if (rts->value < 0 || rts->value > MAX_RTS_THRESHOLD)
1572 return -EINVAL;
1573 else if (rts->value == 0)
1574 val = MAX_RTS_THRESHOLD;
1575 else
1576 val = rts->value;
1577
1578 if (val != pAdapter->CommonCfg.RtsThreshold)
1579 pAdapter->CommonCfg.RtsThreshold = val;
1580
1581 return 0;
1582 }
1583
1584 int rt_ioctl_giwrts(struct net_device *dev,
1585 struct iw_request_info *info,
1586 struct iw_param *rts, char *extra)
1587 {
1588 PRTMP_ADAPTER pAdapter = NULL;
1589 VIRTUAL_ADAPTER *pVirtualAd = NULL;
1590
1591 if (dev->priv_flags == INT_MAIN)
1592 {
1593 pAdapter = dev->ml_priv;
1594 }
1595 else
1596 {
1597 pVirtualAd = dev->ml_priv;
1598 if (pVirtualAd && pVirtualAd->RtmpDev)
1599 pAdapter = pVirtualAd->RtmpDev->ml_priv;
1600 }
1601
1602 if (pAdapter == NULL)
1603 {
1604 /* if 1st open fail, pAd will be free;
1605 So the net_dev->ml_priv will be NULL in 2rd open */
1606 return -ENETDOWN;
1607 }
1608
1609 //check if the interface is down
1610 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1611 {
1612 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1613 return -ENETDOWN;
1614 }
1615
1616 rts->value = pAdapter->CommonCfg.RtsThreshold;
1617 rts->disabled = (rts->value == MAX_RTS_THRESHOLD);
1618 rts->fixed = 1;
1619
1620 return 0;
1621 }
1622
1623 int rt_ioctl_siwfrag(struct net_device *dev,
1624 struct iw_request_info *info,
1625 struct iw_param *frag, char *extra)
1626 {
1627 PRTMP_ADAPTER pAdapter = dev->ml_priv;
1628 u16 val;
1629
1630 //check if the interface is down
1631 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1632 {
1633 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1634 return -ENETDOWN;
1635 }
1636
1637 if (frag->disabled)
1638 val = MAX_FRAG_THRESHOLD;
1639 else if (frag->value >= MIN_FRAG_THRESHOLD || frag->value <= MAX_FRAG_THRESHOLD)
1640 val = __cpu_to_le16(frag->value & ~0x1); /* even numbers only */
1641 else if (frag->value == 0)
1642 val = MAX_FRAG_THRESHOLD;
1643 else
1644 return -EINVAL;
1645
1646 pAdapter->CommonCfg.FragmentThreshold = val;
1647 return 0;
1648 }
1649
1650 int rt_ioctl_giwfrag(struct net_device *dev,
1651 struct iw_request_info *info,
1652 struct iw_param *frag, char *extra)
1653 {
1654 PRTMP_ADAPTER pAdapter = NULL;
1655 VIRTUAL_ADAPTER *pVirtualAd = NULL;
1656
1657 if (dev->priv_flags == INT_MAIN)
1658 {
1659 pAdapter = dev->ml_priv;
1660 }
1661 else
1662 {
1663 pVirtualAd = dev->ml_priv;
1664 if (pVirtualAd && pVirtualAd->RtmpDev)
1665 pAdapter = pVirtualAd->RtmpDev->ml_priv;
1666 }
1667
1668 if (pAdapter == NULL)
1669 {
1670 /* if 1st open fail, pAd will be free;
1671 So the net_dev->ml_priv will be NULL in 2rd open */
1672 return -ENETDOWN;
1673 }
1674
1675 //check if the interface is down
1676 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1677 {
1678 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1679 return -ENETDOWN;
1680 }
1681
1682 frag->value = pAdapter->CommonCfg.FragmentThreshold;
1683 frag->disabled = (frag->value == MAX_FRAG_THRESHOLD);
1684 frag->fixed = 1;
1685
1686 return 0;
1687 }
1688
1689 #define MAX_WEP_KEY_SIZE 13
1690 #define MIN_WEP_KEY_SIZE 5
1691 int rt_ioctl_siwencode(struct net_device *dev,
1692 struct iw_request_info *info,
1693 struct iw_point *erq, char *extra)
1694 {
1695 PRTMP_ADAPTER pAdapter = dev->ml_priv;
1696
1697 //check if the interface is down
1698 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1699 {
1700 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1701 return -ENETDOWN;
1702 }
1703
1704 if ((erq->length == 0) &&
1705 (erq->flags & IW_ENCODE_DISABLED))
1706 {
1707 pAdapter->StaCfg.PairCipher = Ndis802_11WEPDisabled;
1708 pAdapter->StaCfg.GroupCipher = Ndis802_11WEPDisabled;
1709 pAdapter->StaCfg.WepStatus = Ndis802_11WEPDisabled;
1710 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
1711 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
1712 goto done;
1713 }
1714 else if ((erq->length == 0) &&
1715 (erq->flags & IW_ENCODE_RESTRICTED || erq->flags & IW_ENCODE_OPEN))
1716 {
1717 //pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
1718 STA_PORT_SECURED(pAdapter);
1719 pAdapter->StaCfg.PairCipher = Ndis802_11WEPEnabled;
1720 pAdapter->StaCfg.GroupCipher = Ndis802_11WEPEnabled;
1721 pAdapter->StaCfg.WepStatus = Ndis802_11WEPEnabled;
1722 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
1723 if (erq->flags & IW_ENCODE_RESTRICTED)
1724 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeShared;
1725 else
1726 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
1727 goto done;
1728 }
1729
1730 if (erq->length > 0)
1731 {
1732 int keyIdx = (erq->flags & IW_ENCODE_INDEX) - 1;
1733 /* Check the size of the key */
1734 if (erq->length > MAX_WEP_KEY_SIZE) {
1735 return -EINVAL;
1736 }
1737 /* Check key index */
1738 if ((keyIdx < 0) || (keyIdx >= NR_WEP_KEYS))
1739 {
1740 DBGPRINT(RT_DEBUG_TRACE ,("==>rt_ioctl_siwencode::Wrong keyIdx=%d! Using default key instead (%d)\n",
1741 keyIdx, pAdapter->StaCfg.DefaultKeyId));
1742
1743 //Using default key
1744 keyIdx = pAdapter->StaCfg.DefaultKeyId;
1745 }
1746
1747 NdisZeroMemory(pAdapter->SharedKey[BSS0][keyIdx].Key, 16);
1748
1749 if (erq->length == MAX_WEP_KEY_SIZE)
1750 {
1751 pAdapter->SharedKey[BSS0][keyIdx].KeyLen = MAX_WEP_KEY_SIZE;
1752 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CIPHER_WEP128;
1753 }
1754 else if (erq->length == MIN_WEP_KEY_SIZE)
1755 {
1756 pAdapter->SharedKey[BSS0][keyIdx].KeyLen = MIN_WEP_KEY_SIZE;
1757 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CIPHER_WEP64;
1758 }
1759 else
1760 /* Disable the key */
1761 pAdapter->SharedKey[BSS0][keyIdx].KeyLen = 0;
1762
1763 /* Check if the key is not marked as invalid */
1764 if(!(erq->flags & IW_ENCODE_NOKEY)) {
1765 /* Copy the key in the driver */
1766 NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].Key, extra, erq->length);
1767 }
1768 }
1769 else
1770 {
1771 /* Do we want to just set the transmit key index ? */
1772 int index = (erq->flags & IW_ENCODE_INDEX) - 1;
1773 if ((index >= 0) && (index < 4))
1774 {
1775 pAdapter->StaCfg.DefaultKeyId = index;
1776 }
1777 else
1778 /* Don't complain if only change the mode */
1779 if (!(erq->flags & IW_ENCODE_MODE)) {
1780 return -EINVAL;
1781 }
1782 }
1783
1784 done:
1785 DBGPRINT(RT_DEBUG_TRACE ,("==>rt_ioctl_siwencode::erq->flags=%x\n",erq->flags));
1786 DBGPRINT(RT_DEBUG_TRACE ,("==>rt_ioctl_siwencode::AuthMode=%x\n",pAdapter->StaCfg.AuthMode));
1787 DBGPRINT(RT_DEBUG_TRACE ,("==>rt_ioctl_siwencode::DefaultKeyId=%x, KeyLen = %d\n",pAdapter->StaCfg.DefaultKeyId , pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].KeyLen));
1788 DBGPRINT(RT_DEBUG_TRACE ,("==>rt_ioctl_siwencode::WepStatus=%x\n",pAdapter->StaCfg.WepStatus));
1789 return 0;
1790 }
1791
1792 int
1793 rt_ioctl_giwencode(struct net_device *dev,
1794 struct iw_request_info *info,
1795 struct iw_point *erq, char *key)
1796 {
1797 int kid;
1798 PRTMP_ADAPTER pAdapter = NULL;
1799 VIRTUAL_ADAPTER *pVirtualAd = NULL;
1800
1801 if (dev->priv_flags == INT_MAIN)
1802 {
1803 pAdapter = dev->ml_priv;
1804 }
1805 else
1806 {
1807 pVirtualAd = dev->ml_priv;
1808 if (pVirtualAd && pVirtualAd->RtmpDev)
1809 pAdapter = pVirtualAd->RtmpDev->ml_priv;
1810 }
1811
1812 if (pAdapter == NULL)
1813 {
1814 /* if 1st open fail, pAd will be free;
1815 So the net_dev->ml_priv will be NULL in 2rd open */
1816 return -ENETDOWN;
1817 }
1818
1819 //check if the interface is down
1820 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1821 {
1822 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1823 return -ENETDOWN;
1824 }
1825
1826 kid = erq->flags & IW_ENCODE_INDEX;
1827 DBGPRINT(RT_DEBUG_TRACE, ("===>rt_ioctl_giwencode %d\n", erq->flags & IW_ENCODE_INDEX));
1828
1829 if (pAdapter->StaCfg.WepStatus == Ndis802_11WEPDisabled)
1830 {
1831 erq->length = 0;
1832 erq->flags = IW_ENCODE_DISABLED;
1833 }
1834 else if ((kid > 0) && (kid <=4))
1835 {
1836 // copy wep key
1837 erq->flags = kid ; /* NB: base 1 */
1838 if (erq->length > pAdapter->SharedKey[BSS0][kid-1].KeyLen)
1839 erq->length = pAdapter->SharedKey[BSS0][kid-1].KeyLen;
1840 memcpy(key, pAdapter->SharedKey[BSS0][kid-1].Key, erq->length);
1841 //if ((kid == pAdapter->PortCfg.DefaultKeyId))
1842 //erq->flags |= IW_ENCODE_ENABLED; /* XXX */
1843 if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeShared)
1844 erq->flags |= IW_ENCODE_RESTRICTED; /* XXX */
1845 else
1846 erq->flags |= IW_ENCODE_OPEN; /* XXX */
1847
1848 }
1849 else if (kid == 0)
1850 {
1851 if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeShared)
1852 erq->flags |= IW_ENCODE_RESTRICTED; /* XXX */
1853 else
1854 erq->flags |= IW_ENCODE_OPEN; /* XXX */
1855 erq->length = pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].KeyLen;
1856 memcpy(key, pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].Key, erq->length);
1857 // copy default key ID
1858 if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeShared)
1859 erq->flags |= IW_ENCODE_RESTRICTED; /* XXX */
1860 else
1861 erq->flags |= IW_ENCODE_OPEN; /* XXX */
1862 erq->flags = pAdapter->StaCfg.DefaultKeyId + 1; /* NB: base 1 */
1863 erq->flags |= IW_ENCODE_ENABLED; /* XXX */
1864 }
1865
1866 return 0;
1867
1868 }
1869
1870 static int
1871 rt_ioctl_setparam(struct net_device *dev, struct iw_request_info *info,
1872 void *w, char *extra)
1873 {
1874 VIRTUAL_ADAPTER *pVirtualAd = NULL;
1875 PRTMP_ADAPTER pAdapter;
1876 POS_COOKIE pObj;
1877 char *this_char = extra;
1878 char *value;
1879 int Status=0;
1880
1881 if (dev->priv_flags == INT_MAIN)
1882 {
1883 pAdapter = dev->ml_priv;
1884 }
1885 else
1886 {
1887 pVirtualAd = dev->ml_priv;
1888 pAdapter = pVirtualAd->RtmpDev->ml_priv;
1889 }
1890 pObj = (POS_COOKIE) pAdapter->OS_Cookie;
1891
1892 if (pAdapter == NULL)
1893 {
1894 /* if 1st open fail, pAd will be free;
1895 So the net_dev->ml_priv will be NULL in 2rd open */
1896 return -ENETDOWN;
1897 }
1898
1899 {
1900 pObj->ioctl_if_type = INT_MAIN;
1901 pObj->ioctl_if = MAIN_MBSSID;
1902 }
1903
1904 //check if the interface is down
1905 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
1906 {
1907 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
1908 return -ENETDOWN;
1909 }
1910
1911 if (!*this_char)
1912 return -EINVAL;
1913
1914 if ((value = rtstrchr(this_char, '=')) != NULL)
1915 *value++ = 0;
1916
1917 if (!value)
1918 return -EINVAL;
1919
1920 // reject setting nothing besides ANY ssid(ssidLen=0)
1921 if (!*value && (strcmp(this_char, "SSID") != 0))
1922 return -EINVAL;
1923
1924 for (PRTMP_PRIVATE_SET_PROC = RTMP_PRIVATE_SUPPORT_PROC; PRTMP_PRIVATE_SET_PROC->name; PRTMP_PRIVATE_SET_PROC++)
1925 {
1926 if (strcmp(this_char, PRTMP_PRIVATE_SET_PROC->name) == 0)
1927 {
1928 if(!PRTMP_PRIVATE_SET_PROC->set_proc(pAdapter, value))
1929 { //FALSE:Set private failed then return Invalid argument
1930 Status = -EINVAL;
1931 }
1932 break; //Exit for loop.
1933 }
1934 }
1935
1936 if(PRTMP_PRIVATE_SET_PROC->name == NULL)
1937 { //Not found argument
1938 Status = -EINVAL;
1939 DBGPRINT(RT_DEBUG_TRACE, ("===>rt_ioctl_setparam:: (iwpriv) Not Support Set Command [%s=%s]\n", this_char, value));
1940 }
1941
1942 return Status;
1943 }
1944
1945
1946 static int
1947 rt_private_get_statistics(struct net_device *dev, struct iw_request_info *info,
1948 struct iw_point *wrq, char *extra)
1949 {
1950 INT Status = 0;
1951 PRTMP_ADAPTER pAd = dev->ml_priv;
1952
1953 if (extra == NULL)
1954 {
1955 wrq->length = 0;
1956 return -EIO;
1957 }
1958
1959 memset(extra, 0x00, IW_PRIV_SIZE_MASK);
1960 sprintf(extra, "\n\n");
1961
1962 #ifdef RALINK_ATE
1963 if (ATE_ON(pAd))
1964 {
1965 sprintf(extra+strlen(extra), "Tx success = %ld\n", (ULONG)pAd->ate.TxDoneCount);
1966 //sprintf(extra+strlen(extra), "Tx success without retry = %ld\n", (ULONG)pAd->ate.TxDoneCount);
1967 }
1968 else
1969 #endif // RALINK_ATE //
1970 {
1971 sprintf(extra+strlen(extra), "Tx success = %ld\n", (ULONG)pAd->WlanCounters.TransmittedFragmentCount.QuadPart);
1972 sprintf(extra+strlen(extra), "Tx success without retry = %ld\n", (ULONG)pAd->WlanCounters.TransmittedFragmentCount.QuadPart - (ULONG)pAd->WlanCounters.RetryCount.QuadPart);
1973 }
1974 sprintf(extra+strlen(extra), "Tx success after retry = %ld\n", (ULONG)pAd->WlanCounters.RetryCount.QuadPart);
1975 sprintf(extra+strlen(extra), "Tx fail to Rcv ACK after retry = %ld\n", (ULONG)pAd->WlanCounters.FailedCount.QuadPart);
1976 sprintf(extra+strlen(extra), "RTS Success Rcv CTS = %ld\n", (ULONG)pAd->WlanCounters.RTSSuccessCount.QuadPart);
1977 sprintf(extra+strlen(extra), "RTS Fail Rcv CTS = %ld\n", (ULONG)pAd->WlanCounters.RTSFailureCount.QuadPart);
1978
1979 sprintf(extra+strlen(extra), "Rx success = %ld\n", (ULONG)pAd->WlanCounters.ReceivedFragmentCount.QuadPart);
1980 sprintf(extra+strlen(extra), "Rx with CRC = %ld\n", (ULONG)pAd->WlanCounters.FCSErrorCount.QuadPart);
1981 sprintf(extra+strlen(extra), "Rx drop due to out of resource = %ld\n", (ULONG)pAd->Counters8023.RxNoBuffer);
1982 sprintf(extra+strlen(extra), "Rx duplicate frame = %ld\n", (ULONG)pAd->WlanCounters.FrameDuplicateCount.QuadPart);
1983
1984 sprintf(extra+strlen(extra), "False CCA (one second) = %ld\n", (ULONG)pAd->RalinkCounters.OneSecFalseCCACnt);
1985 #ifdef RALINK_ATE
1986 if (ATE_ON(pAd))
1987 {
1988 if (pAd->ate.RxAntennaSel == 0)
1989 {
1990 sprintf(extra+strlen(extra), "RSSI-A = %ld\n", (LONG)(pAd->ate.LastRssi0 - pAd->BbpRssiToDbmDelta));
1991 sprintf(extra+strlen(extra), "RSSI-B (if available) = %ld\n", (LONG)(pAd->ate.LastRssi1 - pAd->BbpRssiToDbmDelta));
1992 sprintf(extra+strlen(extra), "RSSI-C (if available) = %ld\n\n", (LONG)(pAd->ate.LastRssi2 - pAd->BbpRssiToDbmDelta));
1993 }
1994 else
1995 {
1996 sprintf(extra+strlen(extra), "RSSI = %ld\n", (LONG)(pAd->ate.LastRssi0 - pAd->BbpRssiToDbmDelta));
1997 }
1998 }
1999 else
2000 #endif // RALINK_ATE //
2001 {
2002 sprintf(extra+strlen(extra), "RSSI-A = %ld\n", (LONG)(pAd->StaCfg.RssiSample.LastRssi0 - pAd->BbpRssiToDbmDelta));
2003 sprintf(extra+strlen(extra), "RSSI-B (if available) = %ld\n", (LONG)(pAd->StaCfg.RssiSample.LastRssi1 - pAd->BbpRssiToDbmDelta));
2004 sprintf(extra+strlen(extra), "RSSI-C (if available) = %ld\n\n", (LONG)(pAd->StaCfg.RssiSample.LastRssi2 - pAd->BbpRssiToDbmDelta));
2005 }
2006 #ifdef WPA_SUPPLICANT_SUPPORT
2007 sprintf(extra+strlen(extra), "WpaSupplicantUP = %d\n\n", pAd->StaCfg.WpaSupplicantUP);
2008 #endif // WPA_SUPPLICANT_SUPPORT //
2009
2010
2011 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2012 DBGPRINT(RT_DEBUG_TRACE, ("<== rt_private_get_statistics, wrq->length = %d\n", wrq->length));
2013
2014 return Status;
2015 }
2016
2017 #ifdef DOT11_N_SUPPORT
2018 void getBaInfo(
2019 IN PRTMP_ADAPTER pAd,
2020 IN PUCHAR pOutBuf)
2021 {
2022 INT i, j;
2023 BA_ORI_ENTRY *pOriBAEntry;
2024 BA_REC_ENTRY *pRecBAEntry;
2025
2026 for (i=0; i<MAX_LEN_OF_MAC_TABLE; i++)
2027 {
2028 PMAC_TABLE_ENTRY pEntry = &pAd->MacTab.Content[i];
2029 if (((pEntry->ValidAsCLI || pEntry->ValidAsApCli) && (pEntry->Sst == SST_ASSOC))
2030 || (pEntry->ValidAsWDS) || (pEntry->ValidAsMesh))
2031 {
2032 sprintf(pOutBuf + strlen(pOutBuf), "\n%02X:%02X:%02X:%02X:%02X:%02X (Aid = %d) (AP) -\n",
2033 pEntry->Addr[0], pEntry->Addr[1], pEntry->Addr[2],
2034 pEntry->Addr[3], pEntry->Addr[4], pEntry->Addr[5], pEntry->Aid);
2035
2036 sprintf(pOutBuf, "%s[Recipient]\n", pOutBuf);
2037 for (j=0; j < NUM_OF_TID; j++)
2038 {
2039 if (pEntry->BARecWcidArray[j] != 0)
2040 {
2041 pRecBAEntry =&pAd->BATable.BARecEntry[pEntry->BARecWcidArray[j]];
2042 sprintf(pOutBuf + strlen(pOutBuf), "TID=%d, BAWinSize=%d, LastIndSeq=%d, ReorderingPkts=%d\n", j, pRecBAEntry->BAWinSize, pRecBAEntry->LastIndSeq, pRecBAEntry->list.qlen);
2043 }
2044 }
2045 sprintf(pOutBuf, "%s\n", pOutBuf);
2046
2047 sprintf(pOutBuf, "%s[Originator]\n", pOutBuf);
2048 for (j=0; j < NUM_OF_TID; j++)
2049 {
2050 if (pEntry->BAOriWcidArray[j] != 0)
2051 {
2052 pOriBAEntry =&pAd->BATable.BAOriEntry[pEntry->BAOriWcidArray[j]];
2053 sprintf(pOutBuf + strlen(pOutBuf), "TID=%d, BAWinSize=%d, StartSeq=%d, CurTxSeq=%d\n", j, pOriBAEntry->BAWinSize, pOriBAEntry->Sequence, pEntry->TxSeq[j]);
2054 }
2055 }
2056 sprintf(pOutBuf, "%s\n\n", pOutBuf);
2057 }
2058 if (strlen(pOutBuf) > (IW_PRIV_SIZE_MASK - 30))
2059 break;
2060 }
2061
2062 return;
2063 }
2064 #endif // DOT11_N_SUPPORT //
2065
2066 static int
2067 rt_private_show(struct net_device *dev, struct iw_request_info *info,
2068 struct iw_point *wrq, char *extra)
2069 {
2070 INT Status = 0;
2071 VIRTUAL_ADAPTER *pVirtualAd = NULL;
2072 PRTMP_ADAPTER pAd;
2073 POS_COOKIE pObj;
2074 u32 subcmd = wrq->flags;
2075
2076 if (dev->priv_flags == INT_MAIN)
2077 pAd = dev->ml_priv;
2078 else
2079 {
2080 pVirtualAd = dev->ml_priv;
2081 pAd = pVirtualAd->RtmpDev->ml_priv;
2082 }
2083 pObj = (POS_COOKIE) pAd->OS_Cookie;
2084
2085 if (pAd == NULL)
2086 {
2087 /* if 1st open fail, pAd will be free;
2088 So the net_dev->ml_priv will be NULL in 2rd open */
2089 return -ENETDOWN;
2090 }
2091
2092 if (extra == NULL)
2093 {
2094 wrq->length = 0;
2095 return -EIO;
2096 }
2097 memset(extra, 0x00, IW_PRIV_SIZE_MASK);
2098
2099 {
2100 pObj->ioctl_if_type = INT_MAIN;
2101 pObj->ioctl_if = MAIN_MBSSID;
2102 }
2103
2104 switch(subcmd)
2105 {
2106
2107 case SHOW_CONN_STATUS:
2108 if (MONITOR_ON(pAd))
2109 {
2110 #ifdef DOT11_N_SUPPORT
2111 if (pAd->CommonCfg.PhyMode >= PHY_11ABGN_MIXED &&
2112 pAd->CommonCfg.RegTransmitSetting.field.BW)
2113 sprintf(extra, "Monitor Mode(CentralChannel %d)\n", pAd->CommonCfg.CentralChannel);
2114 else
2115 #endif // DOT11_N_SUPPORT //
2116 sprintf(extra, "Monitor Mode(Channel %d)\n", pAd->CommonCfg.Channel);
2117 }
2118 else
2119 {
2120 if (pAd->IndicateMediaState == NdisMediaStateConnected)
2121 {
2122 if (INFRA_ON(pAd))
2123 {
2124 sprintf(extra, "Connected(AP: %s[%02X:%02X:%02X:%02X:%02X:%02X])\n",
2125 pAd->CommonCfg.Ssid,
2126 pAd->CommonCfg.Bssid[0],
2127 pAd->CommonCfg.Bssid[1],
2128 pAd->CommonCfg.Bssid[2],
2129 pAd->CommonCfg.Bssid[3],
2130 pAd->CommonCfg.Bssid[4],
2131 pAd->CommonCfg.Bssid[5]);
2132 DBGPRINT(RT_DEBUG_TRACE ,("Ssid=%s ,Ssidlen = %d\n",pAd->CommonCfg.Ssid, pAd->CommonCfg.SsidLen));
2133 }
2134 else if (ADHOC_ON(pAd))
2135 sprintf(extra, "Connected\n");
2136 }
2137 else
2138 {
2139 sprintf(extra, "Disconnected\n");
2140 DBGPRINT(RT_DEBUG_TRACE ,("ConnStatus is not connected\n"));
2141 }
2142 }
2143 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2144 break;
2145 case SHOW_DRVIER_VERION:
2146 sprintf(extra, "Driver version-%s, %s %s\n", STA_DRIVER_VERSION, __DATE__, __TIME__ );
2147 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2148 break;
2149 #ifdef DOT11_N_SUPPORT
2150 case SHOW_BA_INFO:
2151 getBaInfo(pAd, extra);
2152 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2153 break;
2154 #endif // DOT11_N_SUPPORT //
2155 case SHOW_DESC_INFO:
2156 {
2157 Show_DescInfo_Proc(pAd, NULL);
2158 wrq->length = 0; // 1: size of '\0'
2159 }
2160 break;
2161 case RAIO_OFF:
2162 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
2163 {
2164 sprintf(extra, "Scanning\n");
2165 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2166 break;
2167 }
2168 pAd->StaCfg.bSwRadio = FALSE;
2169 if (pAd->StaCfg.bRadio != (pAd->StaCfg.bHwRadio && pAd->StaCfg.bSwRadio))
2170 {
2171 pAd->StaCfg.bRadio = (pAd->StaCfg.bHwRadio && pAd->StaCfg.bSwRadio);
2172 if (pAd->StaCfg.bRadio == FALSE)
2173 {
2174 MlmeRadioOff(pAd);
2175 // Update extra information
2176 pAd->ExtraInfo = SW_RADIO_OFF;
2177 }
2178 }
2179 sprintf(extra, "Radio Off\n");
2180 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2181 break;
2182 case RAIO_ON:
2183 if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
2184 {
2185 sprintf(extra, "Scanning\n");
2186 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2187 break;
2188 }
2189 pAd->StaCfg.bSwRadio = TRUE;
2190 //if (pAd->StaCfg.bRadio != (pAd->StaCfg.bHwRadio && pAd->StaCfg.bSwRadio))
2191 {
2192 pAd->StaCfg.bRadio = (pAd->StaCfg.bHwRadio && pAd->StaCfg.bSwRadio);
2193 if (pAd->StaCfg.bRadio == TRUE)
2194 {
2195 MlmeRadioOn(pAd);
2196 // Update extra information
2197 pAd->ExtraInfo = EXTRA_INFO_CLEAR;
2198 }
2199 }
2200 sprintf(extra, "Radio On\n");
2201 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2202 break;
2203
2204
2205 #ifdef QOS_DLS_SUPPORT
2206 case SHOW_DLS_ENTRY_INFO:
2207 {
2208 Set_DlsEntryInfo_Display_Proc(pAd, NULL);
2209 wrq->length = 0; // 1: size of '\0'
2210 }
2211 break;
2212 #endif // QOS_DLS_SUPPORT //
2213
2214 case SHOW_CFG_VALUE:
2215 {
2216 Status = RTMPShowCfgValue(pAd, wrq->pointer, extra);
2217 if (Status == 0)
2218 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2219 }
2220 break;
2221 case SHOW_ADHOC_ENTRY_INFO:
2222 Show_Adhoc_MacTable_Proc(pAd, extra);
2223 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2224 break;
2225 default:
2226 DBGPRINT(RT_DEBUG_TRACE, ("%s - unknow subcmd = %d\n", __func__, subcmd));
2227 break;
2228 }
2229
2230 return Status;
2231 }
2232
2233 #ifdef SIOCSIWMLME
2234 int rt_ioctl_siwmlme(struct net_device *dev,
2235 struct iw_request_info *info,
2236 union iwreq_data *wrqu,
2237 char *extra)
2238 {
2239 PRTMP_ADAPTER pAd = dev->ml_priv;
2240 struct iw_mlme *pMlme = (struct iw_mlme *)wrqu->data.pointer;
2241 MLME_QUEUE_ELEM MsgElem;
2242 MLME_DISASSOC_REQ_STRUCT DisAssocReq;
2243 MLME_DEAUTH_REQ_STRUCT DeAuthReq;
2244
2245 DBGPRINT(RT_DEBUG_TRACE, ("====> %s\n", __func__));
2246
2247 if (pMlme == NULL)
2248 return -EINVAL;
2249
2250 switch(pMlme->cmd)
2251 {
2252 #ifdef IW_MLME_DEAUTH
2253 case IW_MLME_DEAUTH:
2254 DBGPRINT(RT_DEBUG_TRACE, ("====> %s - IW_MLME_DEAUTH\n", __func__));
2255 COPY_MAC_ADDR(DeAuthReq.Addr, pAd->CommonCfg.Bssid);
2256 DeAuthReq.Reason = pMlme->reason_code;
2257 MsgElem.MsgLen = sizeof(MLME_DEAUTH_REQ_STRUCT);
2258 NdisMoveMemory(MsgElem.Msg, &DeAuthReq, sizeof(MLME_DEAUTH_REQ_STRUCT));
2259 MlmeDeauthReqAction(pAd, &MsgElem);
2260 if (INFRA_ON(pAd))
2261 {
2262 LinkDown(pAd, FALSE);
2263 pAd->Mlme.AssocMachine.CurrState = ASSOC_IDLE;
2264 }
2265 break;
2266 #endif // IW_MLME_DEAUTH //
2267 #ifdef IW_MLME_DISASSOC
2268 case IW_MLME_DISASSOC:
2269 DBGPRINT(RT_DEBUG_TRACE, ("====> %s - IW_MLME_DISASSOC\n", __func__));
2270 COPY_MAC_ADDR(DisAssocReq.Addr, pAd->CommonCfg.Bssid);
2271 DisAssocReq.Reason = pMlme->reason_code;
2272
2273 MsgElem.Machine = ASSOC_STATE_MACHINE;
2274 MsgElem.MsgType = MT2_MLME_DISASSOC_REQ;
2275 MsgElem.MsgLen = sizeof(MLME_DISASSOC_REQ_STRUCT);
2276 NdisMoveMemory(MsgElem.Msg, &DisAssocReq, sizeof(MLME_DISASSOC_REQ_STRUCT));
2277
2278 pAd->Mlme.CntlMachine.CurrState = CNTL_WAIT_OID_DISASSOC;
2279 MlmeDisassocReqAction(pAd, &MsgElem);
2280 break;
2281 #endif // IW_MLME_DISASSOC //
2282 default:
2283 DBGPRINT(RT_DEBUG_TRACE, ("====> %s - Unknow Command\n", __func__));
2284 break;
2285 }
2286
2287 return 0;
2288 }
2289 #endif // SIOCSIWMLME //
2290
2291 #if WIRELESS_EXT > 17
2292 int rt_ioctl_siwauth(struct net_device *dev,
2293 struct iw_request_info *info,
2294 union iwreq_data *wrqu, char *extra)
2295 {
2296 PRTMP_ADAPTER pAdapter = dev->ml_priv;
2297 struct iw_param *param = &wrqu->param;
2298
2299 //check if the interface is down
2300 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
2301 {
2302 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
2303 return -ENETDOWN;
2304 }
2305 switch (param->flags & IW_AUTH_INDEX) {
2306 case IW_AUTH_WPA_VERSION:
2307 if (param->value == IW_AUTH_WPA_VERSION_WPA)
2308 {
2309 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPAPSK;
2310 if (pAdapter->StaCfg.BssType == BSS_ADHOC)
2311 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPANone;
2312 }
2313 else if (param->value == IW_AUTH_WPA_VERSION_WPA2)
2314 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPA2PSK;
2315
2316 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_WPA_VERSION - param->value = %d!\n", __func__, param->value));
2317 break;
2318 case IW_AUTH_CIPHER_PAIRWISE:
2319 if (param->value == IW_AUTH_CIPHER_NONE)
2320 {
2321 pAdapter->StaCfg.WepStatus = Ndis802_11WEPDisabled;
2322 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
2323 pAdapter->StaCfg.PairCipher = Ndis802_11WEPDisabled;
2324 }
2325 else if (param->value == IW_AUTH_CIPHER_WEP40 ||
2326 param->value == IW_AUTH_CIPHER_WEP104)
2327 {
2328 pAdapter->StaCfg.WepStatus = Ndis802_11WEPEnabled;
2329 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
2330 pAdapter->StaCfg.PairCipher = Ndis802_11WEPEnabled;
2331 #ifdef WPA_SUPPLICANT_SUPPORT
2332 pAdapter->StaCfg.IEEE8021X = FALSE;
2333 #endif // WPA_SUPPLICANT_SUPPORT //
2334 }
2335 else if (param->value == IW_AUTH_CIPHER_TKIP)
2336 {
2337 pAdapter->StaCfg.WepStatus = Ndis802_11Encryption2Enabled;
2338 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
2339 pAdapter->StaCfg.PairCipher = Ndis802_11Encryption2Enabled;
2340 }
2341 else if (param->value == IW_AUTH_CIPHER_CCMP)
2342 {
2343 pAdapter->StaCfg.WepStatus = Ndis802_11Encryption3Enabled;
2344 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
2345 pAdapter->StaCfg.PairCipher = Ndis802_11Encryption3Enabled;
2346 }
2347 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_CIPHER_PAIRWISE - param->value = %d!\n", __func__, param->value));
2348 break;
2349 case IW_AUTH_CIPHER_GROUP:
2350 if (param->value == IW_AUTH_CIPHER_NONE)
2351 {
2352 pAdapter->StaCfg.GroupCipher = Ndis802_11WEPDisabled;
2353 }
2354 else if (param->value == IW_AUTH_CIPHER_WEP40 ||
2355 param->value == IW_AUTH_CIPHER_WEP104)
2356 {
2357 pAdapter->StaCfg.GroupCipher = Ndis802_11WEPEnabled;
2358 }
2359 else if (param->value == IW_AUTH_CIPHER_TKIP)
2360 {
2361 pAdapter->StaCfg.GroupCipher = Ndis802_11Encryption2Enabled;
2362 }
2363 else if (param->value == IW_AUTH_CIPHER_CCMP)
2364 {
2365 pAdapter->StaCfg.GroupCipher = Ndis802_11Encryption3Enabled;
2366 }
2367 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_CIPHER_GROUP - param->value = %d!\n", __func__, param->value));
2368 break;
2369 case IW_AUTH_KEY_MGMT:
2370 if (param->value == IW_AUTH_KEY_MGMT_802_1X)
2371 {
2372 if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK)
2373 {
2374 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPA;
2375 #ifdef WPA_SUPPLICANT_SUPPORT
2376 pAdapter->StaCfg.IEEE8021X = FALSE;
2377 #endif // WPA_SUPPLICANT_SUPPORT //
2378 }
2379 else if (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK)
2380 {
2381 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPA2;
2382 #ifdef WPA_SUPPLICANT_SUPPORT
2383 pAdapter->StaCfg.IEEE8021X = FALSE;
2384 #endif // WPA_SUPPLICANT_SUPPORT //
2385 }
2386 #ifdef WPA_SUPPLICANT_SUPPORT
2387 else
2388 // WEP 1x
2389 pAdapter->StaCfg.IEEE8021X = TRUE;
2390 #endif // WPA_SUPPLICANT_SUPPORT //
2391 }
2392 else if (param->value == 0)
2393 {
2394 //pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
2395 STA_PORT_SECURED(pAdapter);
2396 }
2397 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_KEY_MGMT - param->value = %d!\n", __func__, param->value));
2398 break;
2399 case IW_AUTH_RX_UNENCRYPTED_EAPOL:
2400 break;
2401 case IW_AUTH_PRIVACY_INVOKED:
2402 /*if (param->value == 0)
2403 {
2404 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
2405 pAdapter->StaCfg.WepStatus = Ndis802_11WEPDisabled;
2406 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
2407 pAdapter->StaCfg.PairCipher = Ndis802_11WEPDisabled;
2408 pAdapter->StaCfg.GroupCipher = Ndis802_11WEPDisabled;
2409 }*/
2410 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_PRIVACY_INVOKED - param->value = %d!\n", __func__, param->value));
2411 break;
2412 case IW_AUTH_DROP_UNENCRYPTED:
2413 if (param->value != 0)
2414 pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
2415 else
2416 {
2417 //pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
2418 STA_PORT_SECURED(pAdapter);
2419 }
2420 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_WPA_VERSION - param->value = %d!\n", __func__, param->value));
2421 break;
2422 case IW_AUTH_80211_AUTH_ALG:
2423 if (param->value & IW_AUTH_ALG_SHARED_KEY)
2424 {
2425 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeShared;
2426 }
2427 else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM)
2428 {
2429 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
2430 }
2431 else
2432 return -EINVAL;
2433 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_80211_AUTH_ALG - param->value = %d!\n", __func__, param->value));
2434 break;
2435 case IW_AUTH_WPA_ENABLED:
2436 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_AUTH_WPA_ENABLED - Driver supports WPA!(param->value = %d)\n", __func__, param->value));
2437 break;
2438 default:
2439 return -EOPNOTSUPP;
2440 }
2441
2442 return 0;
2443 }
2444
2445 int rt_ioctl_giwauth(struct net_device *dev,
2446 struct iw_request_info *info,
2447 union iwreq_data *wrqu, char *extra)
2448 {
2449 PRTMP_ADAPTER pAdapter = dev->ml_priv;
2450 struct iw_param *param = &wrqu->param;
2451
2452 //check if the interface is down
2453 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
2454 {
2455 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
2456 return -ENETDOWN;
2457 }
2458
2459 switch (param->flags & IW_AUTH_INDEX) {
2460 case IW_AUTH_DROP_UNENCRYPTED:
2461 param->value = (pAdapter->StaCfg.WepStatus == Ndis802_11WEPDisabled) ? 0 : 1;
2462 break;
2463
2464 case IW_AUTH_80211_AUTH_ALG:
2465 param->value = (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeShared) ? IW_AUTH_ALG_SHARED_KEY : IW_AUTH_ALG_OPEN_SYSTEM;
2466 break;
2467
2468 case IW_AUTH_WPA_ENABLED:
2469 param->value = (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA) ? 1 : 0;
2470 break;
2471
2472 default:
2473 return -EOPNOTSUPP;
2474 }
2475 DBGPRINT(RT_DEBUG_TRACE, ("rt_ioctl_giwauth::param->value = %d!\n", param->value));
2476 return 0;
2477 }
2478
2479 void fnSetCipherKey(
2480 IN PRTMP_ADAPTER pAdapter,
2481 IN INT keyIdx,
2482 IN UCHAR CipherAlg,
2483 IN BOOLEAN bGTK,
2484 IN struct iw_encode_ext *ext)
2485 {
2486 NdisZeroMemory(&pAdapter->SharedKey[BSS0][keyIdx], sizeof(CIPHER_KEY));
2487 pAdapter->SharedKey[BSS0][keyIdx].KeyLen = LEN_TKIP_EK;
2488 NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].Key, ext->key, LEN_TKIP_EK);
2489 NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].TxMic, ext->key + LEN_TKIP_EK, LEN_TKIP_TXMICK);
2490 NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].RxMic, ext->key + LEN_TKIP_EK + LEN_TKIP_TXMICK, LEN_TKIP_RXMICK);
2491 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CipherAlg;
2492
2493 // Update group key information to ASIC Shared Key Table
2494 AsicAddSharedKeyEntry(pAdapter,
2495 BSS0,
2496 keyIdx,
2497 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg,
2498 pAdapter->SharedKey[BSS0][keyIdx].Key,
2499 pAdapter->SharedKey[BSS0][keyIdx].TxMic,
2500 pAdapter->SharedKey[BSS0][keyIdx].RxMic);
2501
2502 if (bGTK)
2503 // Update ASIC WCID attribute table and IVEIV table
2504 RTMPAddWcidAttributeEntry(pAdapter,
2505 BSS0,
2506 keyIdx,
2507 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg,
2508 NULL);
2509 else
2510 // Update ASIC WCID attribute table and IVEIV table
2511 RTMPAddWcidAttributeEntry(pAdapter,
2512 BSS0,
2513 keyIdx,
2514 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg,
2515 &pAdapter->MacTab.Content[BSSID_WCID]);
2516 }
2517
2518 int rt_ioctl_siwencodeext(struct net_device *dev,
2519 struct iw_request_info *info,
2520 union iwreq_data *wrqu,
2521 char *extra)
2522 {
2523 PRTMP_ADAPTER pAdapter = dev->ml_priv;
2524 struct iw_point *encoding = &wrqu->encoding;
2525 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
2526 int keyIdx, alg = ext->alg;
2527
2528 //check if the interface is down
2529 if(!RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_INTERRUPT_IN_USE))
2530 {
2531 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
2532 return -ENETDOWN;
2533 }
2534
2535 if (encoding->flags & IW_ENCODE_DISABLED)
2536 {
2537 keyIdx = (encoding->flags & IW_ENCODE_INDEX) - 1;
2538 // set BSSID wcid entry of the Pair-wise Key table as no-security mode
2539 AsicRemovePairwiseKeyEntry(pAdapter, BSS0, BSSID_WCID);
2540 pAdapter->SharedKey[BSS0][keyIdx].KeyLen = 0;
2541 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CIPHER_NONE;
2542 AsicRemoveSharedKeyEntry(pAdapter, 0, (UCHAR)keyIdx);
2543 NdisZeroMemory(&pAdapter->SharedKey[BSS0][keyIdx], sizeof(CIPHER_KEY));
2544 DBGPRINT(RT_DEBUG_TRACE, ("%s::Remove all keys!(encoding->flags = %x)\n", __func__, encoding->flags));
2545 }
2546 else
2547 {
2548 // Get Key Index and convet to our own defined key index
2549 keyIdx = (encoding->flags & IW_ENCODE_INDEX) - 1;
2550 if((keyIdx < 0) || (keyIdx >= NR_WEP_KEYS))
2551 return -EINVAL;
2552
2553 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY)
2554 {
2555 pAdapter->StaCfg.DefaultKeyId = keyIdx;
2556 DBGPRINT(RT_DEBUG_TRACE, ("%s::DefaultKeyId = %d\n", __func__, pAdapter->StaCfg.DefaultKeyId));
2557 }
2558
2559 switch (alg) {
2560 case IW_ENCODE_ALG_NONE:
2561 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_ENCODE_ALG_NONE\n", __func__));
2562 break;
2563 case IW_ENCODE_ALG_WEP:
2564 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_ENCODE_ALG_WEP - ext->key_len = %d, keyIdx = %d\n", __func__, ext->key_len, keyIdx));
2565 if (ext->key_len == MAX_WEP_KEY_SIZE)
2566 {
2567 pAdapter->SharedKey[BSS0][keyIdx].KeyLen = MAX_WEP_KEY_SIZE;
2568 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CIPHER_WEP128;
2569 }
2570 else if (ext->key_len == MIN_WEP_KEY_SIZE)
2571 {
2572 pAdapter->SharedKey[BSS0][keyIdx].KeyLen = MIN_WEP_KEY_SIZE;
2573 pAdapter->SharedKey[BSS0][keyIdx].CipherAlg = CIPHER_WEP64;
2574 }
2575 else
2576 return -EINVAL;
2577
2578 NdisZeroMemory(pAdapter->SharedKey[BSS0][keyIdx].Key, 16);
2579 NdisMoveMemory(pAdapter->SharedKey[BSS0][keyIdx].Key, ext->key, ext->key_len);
2580
2581 if (pAdapter->StaCfg.GroupCipher == Ndis802_11GroupWEP40Enabled ||
2582 pAdapter->StaCfg.GroupCipher == Ndis802_11GroupWEP104Enabled)
2583 {
2584 // Set Group key material to Asic
2585 AsicAddSharedKeyEntry(pAdapter, BSS0, keyIdx, pAdapter->SharedKey[BSS0][keyIdx].CipherAlg, pAdapter->SharedKey[BSS0][keyIdx].Key, NULL, NULL);
2586
2587 // Update WCID attribute table and IVEIV table for this group key table
2588 RTMPAddWcidAttributeEntry(pAdapter, BSS0, keyIdx, pAdapter->SharedKey[BSS0][keyIdx].CipherAlg, NULL);
2589
2590 STA_PORT_SECURED(pAdapter);
2591
2592 // Indicate Connected for GUI
2593 pAdapter->IndicateMediaState = NdisMediaStateConnected;
2594 }
2595 break;
2596 case IW_ENCODE_ALG_TKIP:
2597 DBGPRINT(RT_DEBUG_TRACE, ("%s::IW_ENCODE_ALG_TKIP - keyIdx = %d, ext->key_len = %d\n", __func__, keyIdx, ext->key_len));
2598 if (ext->key_len == 32)
2599 {
2600 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY)
2601 {
2602 fnSetCipherKey(pAdapter, keyIdx, CIPHER_TKIP, FALSE, ext);
2603 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA2)
2604 {
2605 //pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
2606 STA_PORT_SECURED(pAdapter);
2607 }
2608 }
2609 else if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
2610 {
2611 fnSetCipherKey(pAdapter, keyIdx, CIPHER_TKIP, TRUE, ext);
2612
2613 // set 802.1x port control
2614 //pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
2615 STA_PORT_SECURED(pAdapter);
2616 }
2617 }
2618 else
2619 return -EINVAL;
2620 break;
2621 case IW_ENCODE_ALG_CCMP:
2622 if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY)
2623 {
2624 fnSetCipherKey(pAdapter, keyIdx, CIPHER_AES, FALSE, ext);
2625 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA2)
2626 //pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
2627 STA_PORT_SECURED(pAdapter);
2628 }
2629 else if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
2630 {
2631 fnSetCipherKey(pAdapter, keyIdx, CIPHER_AES, TRUE, ext);
2632
2633 // set 802.1x port control
2634 //pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
2635 STA_PORT_SECURED(pAdapter);
2636 }
2637 break;
2638 default:
2639 return -EINVAL;
2640 }
2641 }
2642
2643 return 0;
2644 }
2645
2646 int
2647 rt_ioctl_giwencodeext(struct net_device *dev,
2648 struct iw_request_info *info,
2649 union iwreq_data *wrqu, char *extra)
2650 {
2651 PRTMP_ADAPTER pAd = dev->ml_priv;
2652 PCHAR pKey = NULL;
2653 struct iw_point *encoding = &wrqu->encoding;
2654 struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
2655 int idx, max_key_len;
2656
2657 DBGPRINT(RT_DEBUG_TRACE ,("===> rt_ioctl_giwencodeext\n"));
2658
2659 max_key_len = encoding->length - sizeof(*ext);
2660 if (max_key_len < 0)
2661 return -EINVAL;
2662
2663 idx = encoding->flags & IW_ENCODE_INDEX;
2664 if (idx)
2665 {
2666 if (idx < 1 || idx > 4)
2667 return -EINVAL;
2668 idx--;
2669
2670 if ((pAd->StaCfg.WepStatus == Ndis802_11Encryption2Enabled) ||
2671 (pAd->StaCfg.WepStatus == Ndis802_11Encryption3Enabled))
2672 {
2673 if (idx != pAd->StaCfg.DefaultKeyId)
2674 {
2675 ext->key_len = 0;
2676 return 0;
2677 }
2678 }
2679 }
2680 else
2681 idx = pAd->StaCfg.DefaultKeyId;
2682
2683 encoding->flags = idx + 1;
2684 memset(ext, 0, sizeof(*ext));
2685
2686 ext->key_len = 0;
2687 switch(pAd->StaCfg.WepStatus) {
2688 case Ndis802_11WEPDisabled:
2689 ext->alg = IW_ENCODE_ALG_NONE;
2690 encoding->flags |= IW_ENCODE_DISABLED;
2691 break;
2692 case Ndis802_11WEPEnabled:
2693 ext->alg = IW_ENCODE_ALG_WEP;
2694 if (pAd->SharedKey[BSS0][idx].KeyLen > max_key_len)
2695 return -E2BIG;
2696 else
2697 {
2698 ext->key_len = pAd->SharedKey[BSS0][idx].KeyLen;
2699 pKey = &(pAd->SharedKey[BSS0][idx].Key[0]);
2700 }
2701 break;
2702 case Ndis802_11Encryption2Enabled:
2703 case Ndis802_11Encryption3Enabled:
2704 if (pAd->StaCfg.WepStatus == Ndis802_11Encryption2Enabled)
2705 ext->alg = IW_ENCODE_ALG_TKIP;
2706 else
2707 ext->alg = IW_ENCODE_ALG_CCMP;
2708
2709 if (max_key_len < 32)
2710 return -E2BIG;
2711 else
2712 {
2713 ext->key_len = 32;
2714 pKey = &pAd->StaCfg.PMK[0];
2715 }
2716 break;
2717 default:
2718 return -EINVAL;
2719 }
2720
2721 if (ext->key_len && pKey)
2722 {
2723 encoding->flags |= IW_ENCODE_ENABLED;
2724 memcpy(ext->key, pKey, ext->key_len);
2725 }
2726
2727 return 0;
2728 }
2729
2730 #ifdef SIOCSIWGENIE
2731 int rt_ioctl_siwgenie(struct net_device *dev,
2732 struct iw_request_info *info,
2733 union iwreq_data *wrqu, char *extra)
2734 {
2735 PRTMP_ADAPTER pAd = dev->ml_priv;
2736
2737 if (wrqu->data.length > MAX_LEN_OF_RSNIE ||
2738 (wrqu->data.length && extra == NULL))
2739 return -EINVAL;
2740
2741 if (wrqu->data.length)
2742 {
2743 pAd->StaCfg.RSNIE_Len = wrqu->data.length;
2744 NdisMoveMemory(&pAd->StaCfg.RSN_IE[0], extra, pAd->StaCfg.RSNIE_Len);
2745 }
2746 else
2747 {
2748 pAd->StaCfg.RSNIE_Len = 0;
2749 NdisZeroMemory(&pAd->StaCfg.RSN_IE[0], MAX_LEN_OF_RSNIE);
2750 }
2751
2752 return 0;
2753 }
2754 #endif // SIOCSIWGENIE //
2755
2756 int rt_ioctl_giwgenie(struct net_device *dev,
2757 struct iw_request_info *info,
2758 union iwreq_data *wrqu, char *extra)
2759 {
2760 PRTMP_ADAPTER pAd = dev->ml_priv;
2761
2762 if ((pAd->StaCfg.RSNIE_Len == 0) ||
2763 (pAd->StaCfg.AuthMode < Ndis802_11AuthModeWPA))
2764 {
2765 wrqu->data.length = 0;
2766 return 0;
2767 }
2768
2769 #ifdef NATIVE_WPA_SUPPLICANT_SUPPORT
2770 #ifdef SIOCSIWGENIE
2771 if (pAd->StaCfg.WpaSupplicantUP == WPA_SUPPLICANT_ENABLE)
2772 {
2773 if (wrqu->data.length < pAd->StaCfg.RSNIE_Len)
2774 return -E2BIG;
2775
2776 wrqu->data.length = pAd->StaCfg.RSNIE_Len;
2777 memcpy(extra, &pAd->StaCfg.RSN_IE[0], pAd->StaCfg.RSNIE_Len);
2778 }
2779 else
2780 #endif // SIOCSIWGENIE //
2781 #endif // NATIVE_WPA_SUPPLICANT_SUPPORT //
2782 {
2783 UCHAR RSNIe = IE_WPA;
2784
2785 if (wrqu->data.length < (pAd->StaCfg.RSNIE_Len + 2)) // ID, Len
2786 return -E2BIG;
2787 wrqu->data.length = pAd->StaCfg.RSNIE_Len + 2;
2788
2789 if ((pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK) ||
2790 (pAd->StaCfg.AuthMode == Ndis802_11AuthModeWPA2))
2791 RSNIe = IE_RSN;
2792
2793 extra[0] = (char)RSNIe;
2794 extra[1] = pAd->StaCfg.RSNIE_Len;
2795 memcpy(extra+2, &pAd->StaCfg.RSN_IE[0], pAd->StaCfg.RSNIE_Len);
2796 }
2797
2798 return 0;
2799 }
2800
2801 int rt_ioctl_siwpmksa(struct net_device *dev,
2802 struct iw_request_info *info,
2803 union iwreq_data *wrqu,
2804 char *extra)
2805 {
2806 PRTMP_ADAPTER pAd = dev->ml_priv;
2807 struct iw_pmksa *pPmksa = (struct iw_pmksa *)wrqu->data.pointer;
2808 INT CachedIdx = 0, idx = 0;
2809
2810 if (pPmksa == NULL)
2811 return -EINVAL;
2812
2813 DBGPRINT(RT_DEBUG_TRACE ,("===> rt_ioctl_siwpmksa\n"));
2814 switch(pPmksa->cmd)
2815 {
2816 case IW_PMKSA_FLUSH:
2817 NdisZeroMemory(pAd->StaCfg.SavedPMK, sizeof(BSSID_INFO)*PMKID_NO);
2818 DBGPRINT(RT_DEBUG_TRACE ,("rt_ioctl_siwpmksa - IW_PMKSA_FLUSH\n"));
2819 break;
2820 case IW_PMKSA_REMOVE:
2821 for (CachedIdx = 0; CachedIdx < pAd->StaCfg.SavedPMKNum; CachedIdx++)
2822 {
2823 // compare the BSSID
2824 if (NdisEqualMemory(pPmksa->bssid.sa_data, pAd->StaCfg.SavedPMK[CachedIdx].BSSID, MAC_ADDR_LEN))
2825 {
2826 NdisZeroMemory(pAd->StaCfg.SavedPMK[CachedIdx].BSSID, MAC_ADDR_LEN);
2827 NdisZeroMemory(pAd->StaCfg.SavedPMK[CachedIdx].PMKID, 16);
2828 for (idx = CachedIdx; idx < (pAd->StaCfg.SavedPMKNum - 1); idx++)
2829 {
2830 NdisMoveMemory(&pAd->StaCfg.SavedPMK[idx].BSSID[0], &pAd->StaCfg.SavedPMK[idx+1].BSSID[0], MAC_ADDR_LEN);
2831 NdisMoveMemory(&pAd->StaCfg.SavedPMK[idx].PMKID[0], &pAd->StaCfg.SavedPMK[idx+1].PMKID[0], 16);
2832 }
2833 pAd->StaCfg.SavedPMKNum--;
2834 break;
2835 }
2836 }
2837
2838 DBGPRINT(RT_DEBUG_TRACE ,("rt_ioctl_siwpmksa - IW_PMKSA_REMOVE\n"));
2839 break;
2840 case IW_PMKSA_ADD:
2841 for (CachedIdx = 0; CachedIdx < pAd->StaCfg.SavedPMKNum; CachedIdx++)
2842 {
2843 // compare the BSSID
2844 if (NdisEqualMemory(pPmksa->bssid.sa_data, pAd->StaCfg.SavedPMK[CachedIdx].BSSID, MAC_ADDR_LEN))
2845 break;
2846 }
2847
2848 // Found, replace it
2849 if (CachedIdx < PMKID_NO)
2850 {
2851 DBGPRINT(RT_DEBUG_OFF, ("Update PMKID, idx = %d\n", CachedIdx));
2852 NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].BSSID[0], pPmksa->bssid.sa_data, MAC_ADDR_LEN);
2853 NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].PMKID[0], pPmksa->pmkid, 16);
2854 pAd->StaCfg.SavedPMKNum++;
2855 }
2856 // Not found, replace the last one
2857 else
2858 {
2859 // Randomly replace one
2860 CachedIdx = (pPmksa->bssid.sa_data[5] % PMKID_NO);
2861 DBGPRINT(RT_DEBUG_OFF, ("Update PMKID, idx = %d\n", CachedIdx));
2862 NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].BSSID[0], pPmksa->bssid.sa_data, MAC_ADDR_LEN);
2863 NdisMoveMemory(&pAd->StaCfg.SavedPMK[CachedIdx].PMKID[0], pPmksa->pmkid, 16);
2864 }
2865
2866 DBGPRINT(RT_DEBUG_TRACE ,("rt_ioctl_siwpmksa - IW_PMKSA_ADD\n"));
2867 break;
2868 default:
2869 DBGPRINT(RT_DEBUG_TRACE ,("rt_ioctl_siwpmksa - Unknow Command!!\n"));
2870 break;
2871 }
2872
2873 return 0;
2874 }
2875 #endif // #if WIRELESS_EXT > 17
2876
2877 #ifdef DBG
2878 static int
2879 rt_private_ioctl_bbp(struct net_device *dev, struct iw_request_info *info,
2880 struct iw_point *wrq, char *extra)
2881 {
2882 CHAR *this_char;
2883 CHAR *value = NULL;
2884 UCHAR regBBP = 0;
2885 // CHAR arg[255]={0};
2886 UINT32 bbpId;
2887 UINT32 bbpValue;
2888 BOOLEAN bIsPrintAllBBP = FALSE;
2889 INT Status = 0;
2890 PRTMP_ADAPTER pAdapter = dev->ml_priv;
2891
2892
2893 memset(extra, 0x00, IW_PRIV_SIZE_MASK);
2894
2895 if (wrq->length > 1) //No parameters.
2896 {
2897 sprintf(extra, "\n");
2898
2899 //Parsing Read or Write
2900 this_char = wrq->pointer;
2901 DBGPRINT(RT_DEBUG_TRACE, ("this_char=%s\n", this_char));
2902 if (!*this_char)
2903 goto next;
2904
2905 if ((value = rtstrchr(this_char, '=')) != NULL)
2906 *value++ = 0;
2907
2908 if (!value || !*value)
2909 { //Read
2910 DBGPRINT(RT_DEBUG_TRACE, ("this_char=%s, value=%s\n", this_char, value));
2911 if (sscanf(this_char, "%d", &(bbpId)) == 1)
2912 {
2913 if (bbpId <= 136)
2914 {
2915 #ifdef RALINK_ATE
2916 if (ATE_ON(pAdapter))
2917 {
2918 ATE_BBP_IO_READ8_BY_REG_ID(pAdapter, bbpId, &regBBP);
2919 }
2920 else
2921 #endif // RALINK_ATE //
2922 {
2923 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, bbpId, &regBBP);
2924 }
2925 sprintf(extra+strlen(extra), "R%02d[0x%02X]:%02X\n", bbpId, bbpId*2, regBBP);
2926 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2927 DBGPRINT(RT_DEBUG_TRACE, ("msg=%s\n", extra));
2928 }
2929 else
2930 {//Invalid parametes, so default printk all bbp
2931 bIsPrintAllBBP = TRUE;
2932 goto next;
2933 }
2934 }
2935 else
2936 { //Invalid parametes, so default printk all bbp
2937 bIsPrintAllBBP = TRUE;
2938 goto next;
2939 }
2940 }
2941 else
2942 { //Write
2943 if ((sscanf(this_char, "%d", &(bbpId)) == 1) && (sscanf(value, "%x", &(bbpValue)) == 1))
2944 {
2945 if (bbpId <= 136)
2946 {
2947 #ifdef RALINK_ATE
2948 if (ATE_ON(pAdapter))
2949 {
2950 ATE_BBP_IO_WRITE8_BY_REG_ID(pAdapter, bbpId, bbpValue);
2951 //Read it back for showing
2952 ATE_BBP_IO_READ8_BY_REG_ID(pAdapter, bbpId, &regBBP);
2953 }
2954 else
2955 #endif // RALINK_ATE //
2956 {
2957 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, bbpId, bbpValue);
2958 //Read it back for showing
2959 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, bbpId, &regBBP);
2960 }
2961 sprintf(extra+strlen(extra), "R%02d[0x%02X]:%02X\n", bbpId, bbpId*2, regBBP);
2962 wrq->length = strlen(extra) + 1; // 1: size of '\0'
2963 DBGPRINT(RT_DEBUG_TRACE, ("msg=%s\n", extra));
2964 }
2965 else
2966 {//Invalid parametes, so default printk all bbp
2967 bIsPrintAllBBP = TRUE;
2968 goto next;
2969 }
2970 }
2971 else
2972 { //Invalid parametes, so default printk all bbp
2973 bIsPrintAllBBP = TRUE;
2974 goto next;
2975 }
2976 }
2977 }
2978 else
2979 bIsPrintAllBBP = TRUE;
2980
2981 next:
2982 if (bIsPrintAllBBP)
2983 {
2984 memset(extra, 0x00, IW_PRIV_SIZE_MASK);
2985 sprintf(extra, "\n");
2986 for (bbpId = 0; bbpId <= 136; bbpId++)
2987 {
2988 if (strlen(extra) >= (IW_PRIV_SIZE_MASK - 10))
2989 break;
2990 #ifdef RALINK_ATE
2991 if (ATE_ON(pAdapter))
2992 {
2993 ATE_BBP_IO_READ8_BY_REG_ID(pAdapter, bbpId, &regBBP);
2994 }
2995 else
2996 #endif // RALINK_ATE //
2997 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, bbpId, &regBBP);
2998 sprintf(extra+strlen(extra), "R%02d[0x%02X]:%02X ", bbpId, bbpId*2, regBBP);
2999 if (bbpId%5 == 4)
3000 sprintf(extra+strlen(extra), "\n");
3001 }
3002
3003 wrq->length = strlen(extra) + 1; // 1: size of '\0'
3004 DBGPRINT(RT_DEBUG_TRACE, ("wrq->length = %d\n", wrq->length));
3005 }
3006
3007 DBGPRINT(RT_DEBUG_TRACE, ("<==rt_private_ioctl_bbp\n\n"));
3008
3009 return Status;
3010 }
3011 #endif // DBG //
3012
3013 int rt_ioctl_siwrate(struct net_device *dev,
3014 struct iw_request_info *info,
3015 union iwreq_data *wrqu, char *extra)
3016 {
3017 PRTMP_ADAPTER pAd = dev->ml_priv;
3018 UINT32 rate = wrqu->bitrate.value, fixed = wrqu->bitrate.fixed;
3019
3020 //check if the interface is down
3021 if(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
3022 {
3023 DBGPRINT(RT_DEBUG_TRACE, ("rt_ioctl_siwrate::Network is down!\n"));
3024 return -ENETDOWN;
3025 }
3026
3027 DBGPRINT(RT_DEBUG_TRACE, ("rt_ioctl_siwrate::(rate = %d, fixed = %d)\n", rate, fixed));
3028 /* rate = -1 => auto rate
3029 rate = X, fixed = 1 => (fixed rate X)
3030 */
3031 if (rate == -1)
3032 {
3033 //Auto Rate
3034 pAd->StaCfg.DesiredTransmitSetting.field.MCS = MCS_AUTO;
3035 pAd->StaCfg.bAutoTxRateSwitch = TRUE;
3036 if ((pAd->CommonCfg.PhyMode <= PHY_11G) ||
3037 (pAd->MacTab.Content[BSSID_WCID].HTPhyMode.field.MODE <= MODE_OFDM))
3038 RTMPSetDesiredRates(pAd, -1);
3039
3040 #ifdef DOT11_N_SUPPORT
3041 SetCommonHT(pAd);
3042 #endif // DOT11_N_SUPPORT //
3043 }
3044 else
3045 {
3046 if (fixed)
3047 {
3048 pAd->StaCfg.bAutoTxRateSwitch = FALSE;
3049 if ((pAd->CommonCfg.PhyMode <= PHY_11G) ||
3050 (pAd->MacTab.Content[BSSID_WCID].HTPhyMode.field.MODE <= MODE_OFDM))
3051 RTMPSetDesiredRates(pAd, rate);
3052 else
3053 {
3054 pAd->StaCfg.DesiredTransmitSetting.field.MCS = MCS_AUTO;
3055 #ifdef DOT11_N_SUPPORT
3056 SetCommonHT(pAd);
3057 #endif // DOT11_N_SUPPORT //
3058 }
3059 DBGPRINT(RT_DEBUG_TRACE, ("rt_ioctl_siwrate::(HtMcs=%d)\n",pAd->StaCfg.DesiredTransmitSetting.field.MCS));
3060 }
3061 else
3062 {
3063 // TODO: rate = X, fixed = 0 => (rates <= X)
3064 return -EOPNOTSUPP;
3065 }
3066 }
3067
3068 return 0;
3069 }
3070
3071 int rt_ioctl_giwrate(struct net_device *dev,
3072 struct iw_request_info *info,
3073 union iwreq_data *wrqu, char *extra)
3074 {
3075 PRTMP_ADAPTER pAd = dev->ml_priv;
3076 int rate_index = 0, rate_count = 0;
3077 HTTRANSMIT_SETTING ht_setting;
3078 __s32 ralinkrate[] =
3079 {2, 4, 11, 22, // CCK
3080 12, 18, 24, 36, 48, 72, 96, 108, // OFDM
3081 13, 26, 39, 52, 78, 104, 117, 130, 26, 52, 78, 104, 156, 208, 234, 260, // 20MHz, 800ns GI, MCS: 0 ~ 15
3082 39, 78, 117, 156, 234, 312, 351, 390, // 20MHz, 800ns GI, MCS: 16 ~ 23
3083 27, 54, 81, 108, 162, 216, 243, 270, 54, 108, 162, 216, 324, 432, 486, 540, // 40MHz, 800ns GI, MCS: 0 ~ 15
3084 81, 162, 243, 324, 486, 648, 729, 810, // 40MHz, 800ns GI, MCS: 16 ~ 23
3085 14, 29, 43, 57, 87, 115, 130, 144, 29, 59, 87, 115, 173, 230, 260, 288, // 20MHz, 400ns GI, MCS: 0 ~ 15
3086 43, 87, 130, 173, 260, 317, 390, 433, // 20MHz, 400ns GI, MCS: 16 ~ 23
3087 30, 60, 90, 120, 180, 240, 270, 300, 60, 120, 180, 240, 360, 480, 540, 600, // 40MHz, 400ns GI, MCS: 0 ~ 15
3088 90, 180, 270, 360, 540, 720, 810, 900}; // 40MHz, 400ns GI, MCS: 16 ~ 23
3089
3090 rate_count = sizeof(ralinkrate)/sizeof(__s32);
3091 //check if the interface is down
3092 if(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
3093 {
3094 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
3095 return -ENETDOWN;
3096 }
3097
3098 if ((pAd->StaCfg.bAutoTxRateSwitch == FALSE) &&
3099 (INFRA_ON(pAd)) &&
3100 ((pAd->CommonCfg.PhyMode <= PHY_11G) || (pAd->MacTab.Content[BSSID_WCID].HTPhyMode.field.MODE <= MODE_OFDM)))
3101 ht_setting.word = pAd->StaCfg.HTPhyMode.word;
3102 else
3103 ht_setting.word = pAd->MacTab.Content[BSSID_WCID].HTPhyMode.word;
3104
3105 #ifdef DOT11_N_SUPPORT
3106 if (ht_setting.field.MODE >= MODE_HTMIX)
3107 {
3108 // rate_index = 12 + ((UCHAR)ht_setting.field.BW *16) + ((UCHAR)ht_setting.field.ShortGI *32) + ((UCHAR)ht_setting.field.MCS);
3109 rate_index = 12 + ((UCHAR)ht_setting.field.BW *24) + ((UCHAR)ht_setting.field.ShortGI *48) + ((UCHAR)ht_setting.field.MCS);
3110 }
3111 else
3112 #endif // DOT11_N_SUPPORT //
3113 if (ht_setting.field.MODE == MODE_OFDM)
3114 rate_index = (UCHAR)(ht_setting.field.MCS) + 4;
3115 else if (ht_setting.field.MODE == MODE_CCK)
3116 rate_index = (UCHAR)(ht_setting.field.MCS);
3117
3118 if (rate_index < 0)
3119 rate_index = 0;
3120
3121 if (rate_index > rate_count)
3122 rate_index = rate_count;
3123
3124 wrqu->bitrate.value = ralinkrate[rate_index] * 500000;
3125 wrqu->bitrate.disabled = 0;
3126
3127 return 0;
3128 }
3129
3130 static const iw_handler rt_handler[] =
3131 {
3132 (iw_handler) NULL, /* SIOCSIWCOMMIT */
3133 (iw_handler) rt_ioctl_giwname, /* SIOCGIWNAME */
3134 (iw_handler) NULL, /* SIOCSIWNWID */
3135 (iw_handler) NULL, /* SIOCGIWNWID */
3136 (iw_handler) rt_ioctl_siwfreq, /* SIOCSIWFREQ */
3137 (iw_handler) rt_ioctl_giwfreq, /* SIOCGIWFREQ */
3138 (iw_handler) rt_ioctl_siwmode, /* SIOCSIWMODE */
3139 (iw_handler) rt_ioctl_giwmode, /* SIOCGIWMODE */
3140 (iw_handler) NULL, /* SIOCSIWSENS */
3141 (iw_handler) NULL, /* SIOCGIWSENS */
3142 (iw_handler) NULL /* not used */, /* SIOCSIWRANGE */
3143 (iw_handler) rt_ioctl_giwrange, /* SIOCGIWRANGE */
3144 (iw_handler) NULL /* not used */, /* SIOCSIWPRIV */
3145 (iw_handler) NULL /* kernel code */, /* SIOCGIWPRIV */
3146 (iw_handler) NULL /* not used */, /* SIOCSIWSTATS */
3147 (iw_handler) rt28xx_get_wireless_stats /* kernel code */, /* SIOCGIWSTATS */
3148 (iw_handler) NULL, /* SIOCSIWSPY */
3149 (iw_handler) NULL, /* SIOCGIWSPY */
3150 (iw_handler) NULL, /* SIOCSIWTHRSPY */
3151 (iw_handler) NULL, /* SIOCGIWTHRSPY */
3152 (iw_handler) rt_ioctl_siwap, /* SIOCSIWAP */
3153 (iw_handler) rt_ioctl_giwap, /* SIOCGIWAP */
3154 #ifdef SIOCSIWMLME
3155 (iw_handler) rt_ioctl_siwmlme, /* SIOCSIWMLME */
3156 #else
3157 (iw_handler) NULL, /* SIOCSIWMLME */
3158 #endif // SIOCSIWMLME //
3159 (iw_handler) rt_ioctl_iwaplist, /* SIOCGIWAPLIST */
3160 #ifdef SIOCGIWSCAN
3161 (iw_handler) rt_ioctl_siwscan, /* SIOCSIWSCAN */
3162 (iw_handler) rt_ioctl_giwscan, /* SIOCGIWSCAN */
3163 #else
3164 (iw_handler) NULL, /* SIOCSIWSCAN */
3165 (iw_handler) NULL, /* SIOCGIWSCAN */
3166 #endif /* SIOCGIWSCAN */
3167 (iw_handler) rt_ioctl_siwessid, /* SIOCSIWESSID */
3168 (iw_handler) rt_ioctl_giwessid, /* SIOCGIWESSID */
3169 (iw_handler) rt_ioctl_siwnickn, /* SIOCSIWNICKN */
3170 (iw_handler) rt_ioctl_giwnickn, /* SIOCGIWNICKN */
3171 (iw_handler) NULL, /* -- hole -- */
3172 (iw_handler) NULL, /* -- hole -- */
3173 (iw_handler) rt_ioctl_siwrate, /* SIOCSIWRATE */
3174 (iw_handler) rt_ioctl_giwrate, /* SIOCGIWRATE */
3175 (iw_handler) rt_ioctl_siwrts, /* SIOCSIWRTS */
3176 (iw_handler) rt_ioctl_giwrts, /* SIOCGIWRTS */
3177 (iw_handler) rt_ioctl_siwfrag, /* SIOCSIWFRAG */
3178 (iw_handler) rt_ioctl_giwfrag, /* SIOCGIWFRAG */
3179 (iw_handler) NULL, /* SIOCSIWTXPOW */
3180 (iw_handler) NULL, /* SIOCGIWTXPOW */
3181 (iw_handler) NULL, /* SIOCSIWRETRY */
3182 (iw_handler) NULL, /* SIOCGIWRETRY */
3183 (iw_handler) rt_ioctl_siwencode, /* SIOCSIWENCODE */
3184 (iw_handler) rt_ioctl_giwencode, /* SIOCGIWENCODE */
3185 (iw_handler) NULL, /* SIOCSIWPOWER */
3186 (iw_handler) NULL, /* SIOCGIWPOWER */
3187 (iw_handler) NULL, /* -- hole -- */
3188 (iw_handler) NULL, /* -- hole -- */
3189 #if WIRELESS_EXT > 17
3190 (iw_handler) rt_ioctl_siwgenie, /* SIOCSIWGENIE */
3191 (iw_handler) rt_ioctl_giwgenie, /* SIOCGIWGENIE */
3192 (iw_handler) rt_ioctl_siwauth, /* SIOCSIWAUTH */
3193 (iw_handler) rt_ioctl_giwauth, /* SIOCGIWAUTH */
3194 (iw_handler) rt_ioctl_siwencodeext, /* SIOCSIWENCODEEXT */
3195 (iw_handler) rt_ioctl_giwencodeext, /* SIOCGIWENCODEEXT */
3196 (iw_handler) rt_ioctl_siwpmksa, /* SIOCSIWPMKSA */
3197 #endif
3198 };
3199
3200 static const iw_handler rt_priv_handlers[] = {
3201 (iw_handler) NULL, /* + 0x00 */
3202 (iw_handler) NULL, /* + 0x01 */
3203 #ifndef CONFIG_AP_SUPPORT
3204 (iw_handler) rt_ioctl_setparam, /* + 0x02 */
3205 #else
3206 (iw_handler) NULL, /* + 0x02 */
3207 #endif // CONFIG_AP_SUPPORT //
3208 #ifdef DBG
3209 (iw_handler) rt_private_ioctl_bbp, /* + 0x03 */
3210 #else
3211 (iw_handler) NULL, /* + 0x03 */
3212 #endif
3213 (iw_handler) NULL, /* + 0x04 */
3214 (iw_handler) NULL, /* + 0x05 */
3215 (iw_handler) NULL, /* + 0x06 */
3216 (iw_handler) NULL, /* + 0x07 */
3217 (iw_handler) NULL, /* + 0x08 */
3218 (iw_handler) rt_private_get_statistics, /* + 0x09 */
3219 (iw_handler) NULL, /* + 0x0A */
3220 (iw_handler) NULL, /* + 0x0B */
3221 (iw_handler) NULL, /* + 0x0C */
3222 (iw_handler) NULL, /* + 0x0D */
3223 (iw_handler) NULL, /* + 0x0E */
3224 (iw_handler) NULL, /* + 0x0F */
3225 (iw_handler) NULL, /* + 0x10 */
3226 (iw_handler) rt_private_show, /* + 0x11 */
3227 (iw_handler) NULL, /* + 0x12 */
3228 (iw_handler) NULL, /* + 0x13 */
3229 (iw_handler) NULL, /* + 0x15 */
3230 (iw_handler) NULL, /* + 0x17 */
3231 (iw_handler) NULL, /* + 0x18 */
3232 };
3233
3234 const struct iw_handler_def rt28xx_iw_handler_def =
3235 {
3236 #define N(a) (sizeof (a) / sizeof (a[0]))
3237 .standard = (iw_handler *) rt_handler,
3238 .num_standard = sizeof(rt_handler) / sizeof(iw_handler),
3239 .private = (iw_handler *) rt_priv_handlers,
3240 .num_private = N(rt_priv_handlers),
3241 .private_args = (struct iw_priv_args *) privtab,
3242 .num_private_args = N(privtab),
3243 #if IW_HANDLER_VERSION >= 7
3244 .get_wireless_stats = rt28xx_get_wireless_stats,
3245 #endif
3246 };
3247
3248 INT RTMPSetInformation(
3249 IN PRTMP_ADAPTER pAdapter,
3250 IN OUT struct ifreq *rq,
3251 IN INT cmd)
3252 {
3253 struct iwreq *wrq = (struct iwreq *) rq;
3254 NDIS_802_11_SSID Ssid;
3255 NDIS_802_11_MAC_ADDRESS Bssid;
3256 RT_802_11_PHY_MODE PhyMode;
3257 RT_802_11_STA_CONFIG StaConfig;
3258 NDIS_802_11_RATES aryRates;
3259 RT_802_11_PREAMBLE Preamble;
3260 NDIS_802_11_WEP_STATUS WepStatus;
3261 NDIS_802_11_AUTHENTICATION_MODE AuthMode = Ndis802_11AuthModeMax;
3262 NDIS_802_11_NETWORK_INFRASTRUCTURE BssType;
3263 NDIS_802_11_RTS_THRESHOLD RtsThresh;
3264 NDIS_802_11_FRAGMENTATION_THRESHOLD FragThresh;
3265 NDIS_802_11_POWER_MODE PowerMode;
3266 PNDIS_802_11_KEY pKey = NULL;
3267 PNDIS_802_11_WEP pWepKey =NULL;
3268 PNDIS_802_11_REMOVE_KEY pRemoveKey = NULL;
3269 NDIS_802_11_CONFIGURATION Config, *pConfig = NULL;
3270 NDIS_802_11_NETWORK_TYPE NetType;
3271 ULONG Now;
3272 UINT KeyIdx = 0;
3273 INT Status = NDIS_STATUS_SUCCESS, MaxPhyMode = PHY_11G;
3274 ULONG PowerTemp;
3275 BOOLEAN RadioState;
3276 BOOLEAN StateMachineTouched = FALSE;
3277 #ifdef DOT11_N_SUPPORT
3278 OID_SET_HT_PHYMODE HT_PhyMode; //11n ,kathy
3279 #endif // DOT11_N_SUPPORT //
3280 #ifdef WPA_SUPPLICANT_SUPPORT
3281 PNDIS_802_11_PMKID pPmkId = NULL;
3282 BOOLEAN IEEE8021xState = FALSE;
3283 BOOLEAN IEEE8021x_required_keys = FALSE;
3284 UCHAR wpa_supplicant_enable = 0;
3285 #endif // WPA_SUPPLICANT_SUPPORT //
3286
3287 #ifdef SNMP_SUPPORT
3288 TX_RTY_CFG_STRUC tx_rty_cfg;
3289 ULONG ShortRetryLimit, LongRetryLimit;
3290 UCHAR ctmp;
3291 #endif // SNMP_SUPPORT //
3292
3293
3294
3295 #ifdef DOT11_N_SUPPORT
3296 MaxPhyMode = PHY_11N_5G;
3297 #endif // DOT11_N_SUPPORT //
3298
3299
3300 DBGPRINT(RT_DEBUG_TRACE, ("-->RTMPSetInformation(), 0x%08x\n", cmd&0x7FFF));
3301 switch(cmd & 0x7FFF) {
3302 case RT_OID_802_11_COUNTRY_REGION:
3303 if (wrq->u.data.length < sizeof(UCHAR))
3304 Status = -EINVAL;
3305 // Only avaliable when EEPROM not programming
3306 else if (!(pAdapter->CommonCfg.CountryRegion & 0x80) && !(pAdapter->CommonCfg.CountryRegionForABand & 0x80))
3307 {
3308 ULONG Country;
3309 UCHAR TmpPhy;
3310
3311 Status = copy_from_user(&Country, wrq->u.data.pointer, wrq->u.data.length);
3312 pAdapter->CommonCfg.CountryRegion = (UCHAR)(Country & 0x000000FF);
3313 pAdapter->CommonCfg.CountryRegionForABand = (UCHAR)((Country >> 8) & 0x000000FF);
3314 TmpPhy = pAdapter->CommonCfg.PhyMode;
3315 pAdapter->CommonCfg.PhyMode = 0xff;
3316 // Build all corresponding channel information
3317 RTMPSetPhyMode(pAdapter, TmpPhy);
3318 #ifdef DOT11_N_SUPPORT
3319 SetCommonHT(pAdapter);
3320 #endif // DOT11_N_SUPPORT //
3321 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_COUNTRY_REGION (A:%d B/G:%d)\n", pAdapter->CommonCfg.CountryRegionForABand,
3322 pAdapter->CommonCfg.CountryRegion));
3323 }
3324 break;
3325 case OID_802_11_BSSID_LIST_SCAN:
3326 #ifdef RALINK_ATE
3327 if (ATE_ON(pAdapter))
3328 {
3329 DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n"));
3330 break;
3331 }
3332 #endif // RALINK_ATE //
3333 Now = jiffies;
3334 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_BSSID_LIST_SCAN, TxCnt = %d \n", pAdapter->RalinkCounters.LastOneSecTotalTxCount));
3335
3336 if (MONITOR_ON(pAdapter))
3337 {
3338 DBGPRINT(RT_DEBUG_TRACE, ("!!! Driver is in Monitor Mode now !!!\n"));
3339 break;
3340 }
3341
3342 //Benson add 20080527, when radio off, sta don't need to scan
3343 if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_RADIO_OFF))
3344 break;
3345
3346 if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
3347 {
3348 DBGPRINT(RT_DEBUG_TRACE, ("!!! Driver is scanning now !!!\n"));
3349 pAdapter->StaCfg.bScanReqIsFromWebUI = TRUE;
3350 Status = NDIS_STATUS_SUCCESS;
3351 break;
3352 }
3353
3354 if (pAdapter->RalinkCounters.LastOneSecTotalTxCount > 100)
3355 {
3356 DBGPRINT(RT_DEBUG_TRACE, ("!!! Link UP, ignore this set::OID_802_11_BSSID_LIST_SCAN\n"));
3357 Status = NDIS_STATUS_SUCCESS;
3358 pAdapter->StaCfg.ScanCnt = 99; // Prevent auto scan triggered by this OID
3359 break;
3360 }
3361
3362 if ((OPSTATUS_TEST_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED)) &&
3363 ((pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA) ||
3364 (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK) ||
3365 (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA2) ||
3366 (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK)) &&
3367 (pAdapter->StaCfg.PortSecured == WPA_802_1X_PORT_NOT_SECURED))
3368 {
3369 DBGPRINT(RT_DEBUG_TRACE, ("!!! Link UP, Port Not Secured! ignore this set::OID_802_11_BSSID_LIST_SCAN\n"));
3370 Status = NDIS_STATUS_SUCCESS;
3371 pAdapter->StaCfg.ScanCnt = 99; // Prevent auto scan triggered by this OID
3372 break;
3373 }
3374
3375
3376 if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
3377 {
3378 RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
3379 DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
3380 }
3381
3382 // tell CNTL state machine to call NdisMSetInformationComplete() after completing
3383 // this request, because this request is initiated by NDIS.
3384 pAdapter->MlmeAux.CurrReqIsFromNdis = FALSE;
3385 // Reset allowed scan retries
3386 pAdapter->StaCfg.ScanCnt = 0;
3387 pAdapter->StaCfg.LastScanTime = Now;
3388
3389 pAdapter->StaCfg.bScanReqIsFromWebUI = TRUE;
3390 RTMP_SET_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS);
3391 MlmeEnqueue(pAdapter,
3392 MLME_CNTL_STATE_MACHINE,
3393 OID_802_11_BSSID_LIST_SCAN,
3394 0,
3395 NULL);
3396
3397 Status = NDIS_STATUS_SUCCESS;
3398 StateMachineTouched = TRUE;
3399 break;
3400 case OID_802_11_SSID:
3401 if (wrq->u.data.length != sizeof(NDIS_802_11_SSID))
3402 Status = -EINVAL;
3403 else
3404 {
3405 PCHAR pSsidString = NULL;
3406 Status = copy_from_user(&Ssid, wrq->u.data.pointer, wrq->u.data.length);
3407
3408 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SSID (Len=%d,Ssid=%s)\n", Ssid.SsidLength, Ssid.Ssid));
3409 if (Ssid.SsidLength > MAX_LEN_OF_SSID)
3410 Status = -EINVAL;
3411 else
3412 {
3413 if (Ssid.SsidLength == 0)
3414 {
3415 Set_SSID_Proc(pAdapter, "");
3416 }
3417 else
3418 {
3419 pSsidString = (CHAR *) kmalloc(MAX_LEN_OF_SSID+1, MEM_ALLOC_FLAG);
3420 if (pSsidString)
3421 {
3422 NdisZeroMemory(pSsidString, MAX_LEN_OF_SSID+1);
3423 NdisMoveMemory(pSsidString, Ssid.Ssid, Ssid.SsidLength);
3424 Set_SSID_Proc(pAdapter, pSsidString);
3425 kfree(pSsidString);
3426 }
3427 else
3428 Status = -ENOMEM;
3429 }
3430 }
3431 }
3432 break;
3433 case OID_802_11_BSSID:
3434 #ifdef RALINK_ATE
3435 if (ATE_ON(pAdapter))
3436 {
3437 DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n"));
3438 break;
3439 }
3440 #endif // RALINK_ATE //
3441 if (wrq->u.data.length != sizeof(NDIS_802_11_MAC_ADDRESS))
3442 Status = -EINVAL;
3443 else
3444 {
3445 Status = copy_from_user(&Bssid, wrq->u.data.pointer, wrq->u.data.length);
3446
3447 // tell CNTL state machine to call NdisMSetInformationComplete() after completing
3448 // this request, because this request is initiated by NDIS.
3449 pAdapter->MlmeAux.CurrReqIsFromNdis = FALSE;
3450
3451 // Prevent to connect AP again in STAMlmePeriodicExec
3452 pAdapter->MlmeAux.AutoReconnectSsidLen= 32;
3453
3454 // Reset allowed scan retries
3455 pAdapter->StaCfg.ScanCnt = 0;
3456
3457 if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
3458 {
3459 RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
3460 DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
3461 }
3462 MlmeEnqueue(pAdapter,
3463 MLME_CNTL_STATE_MACHINE,
3464 OID_802_11_BSSID,
3465 sizeof(NDIS_802_11_MAC_ADDRESS),
3466 (VOID *)&Bssid);
3467 Status = NDIS_STATUS_SUCCESS;
3468 StateMachineTouched = TRUE;
3469
3470 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_BSSID %02x:%02x:%02x:%02x:%02x:%02x\n",
3471 Bssid[0], Bssid[1], Bssid[2], Bssid[3], Bssid[4], Bssid[5]));
3472 }
3473 break;
3474 case RT_OID_802_11_RADIO:
3475 if (wrq->u.data.length != sizeof(BOOLEAN))
3476 Status = -EINVAL;
3477 else
3478 {
3479 Status = copy_from_user(&RadioState, wrq->u.data.pointer, wrq->u.data.length);
3480 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_RADIO (=%d)\n", RadioState));
3481 if (pAdapter->StaCfg.bSwRadio != RadioState)
3482 {
3483 pAdapter->StaCfg.bSwRadio = RadioState;
3484 if (pAdapter->StaCfg.bRadio != (pAdapter->StaCfg.bHwRadio && pAdapter->StaCfg.bSwRadio))
3485 {
3486 pAdapter->StaCfg.bRadio = (pAdapter->StaCfg.bHwRadio && pAdapter->StaCfg.bSwRadio);
3487 if (pAdapter->StaCfg.bRadio == TRUE)
3488 {
3489 MlmeRadioOn(pAdapter);
3490 // Update extra information
3491 pAdapter->ExtraInfo = EXTRA_INFO_CLEAR;
3492 }
3493 else
3494 {
3495 MlmeRadioOff(pAdapter);
3496 // Update extra information
3497 pAdapter->ExtraInfo = SW_RADIO_OFF;
3498 }
3499 }
3500 }
3501 }
3502 break;
3503 case RT_OID_802_11_PHY_MODE:
3504 if (wrq->u.data.length != sizeof(RT_802_11_PHY_MODE))
3505 Status = -EINVAL;
3506 else
3507 {
3508 Status = copy_from_user(&PhyMode, wrq->u.data.pointer, wrq->u.data.length);
3509 if (PhyMode <= MaxPhyMode)
3510 {
3511 RTMPSetPhyMode(pAdapter, PhyMode);
3512 #ifdef DOT11_N_SUPPORT
3513 SetCommonHT(pAdapter);
3514 #endif // DOT11_N_SUPPORT //
3515 }
3516 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_PHY_MODE (=%d)\n", PhyMode));
3517 }
3518 break;
3519 case RT_OID_802_11_STA_CONFIG:
3520 if (wrq->u.data.length != sizeof(RT_802_11_STA_CONFIG))
3521 Status = -EINVAL;
3522 else
3523 {
3524 Status = copy_from_user(&StaConfig, wrq->u.data.pointer, wrq->u.data.length);
3525 pAdapter->CommonCfg.bEnableTxBurst = StaConfig.EnableTxBurst;
3526 pAdapter->CommonCfg.UseBGProtection = StaConfig.UseBGProtection;
3527 pAdapter->CommonCfg.bUseShortSlotTime = 1; // 2003-10-30 always SHORT SLOT capable
3528 if ((pAdapter->CommonCfg.PhyMode != StaConfig.AdhocMode) &&
3529 (StaConfig.AdhocMode <= MaxPhyMode))
3530 {
3531 // allow dynamic change of "USE OFDM rate or not" in ADHOC mode
3532 // if setting changed, need to reset current TX rate as well as BEACON frame format
3533 if (pAdapter->StaCfg.BssType == BSS_ADHOC)
3534 {
3535 pAdapter->CommonCfg.PhyMode = StaConfig.AdhocMode;
3536 RTMPSetPhyMode(pAdapter, PhyMode);
3537 MlmeUpdateTxRates(pAdapter, FALSE, 0);
3538 MakeIbssBeacon(pAdapter); // re-build BEACON frame
3539 AsicEnableIbssSync(pAdapter); // copy to on-chip memory
3540 }
3541 }
3542 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_STA_CONFIG (Burst=%d, Protection=%ld,ShortSlot=%d\n",
3543 pAdapter->CommonCfg.bEnableTxBurst,
3544 pAdapter->CommonCfg.UseBGProtection,
3545 pAdapter->CommonCfg.bUseShortSlotTime));
3546 }
3547 break;
3548 case OID_802_11_DESIRED_RATES:
3549 if (wrq->u.data.length != sizeof(NDIS_802_11_RATES))
3550 Status = -EINVAL;
3551 else
3552 {
3553 Status = copy_from_user(&aryRates, wrq->u.data.pointer, wrq->u.data.length);
3554 NdisZeroMemory(pAdapter->CommonCfg.DesireRate, MAX_LEN_OF_SUPPORTED_RATES);
3555 NdisMoveMemory(pAdapter->CommonCfg.DesireRate, &aryRates, sizeof(NDIS_802_11_RATES));
3556 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DESIRED_RATES (%02x,%02x,%02x,%02x,%02x,%02x,%02x,%02x)\n",
3557 pAdapter->CommonCfg.DesireRate[0],pAdapter->CommonCfg.DesireRate[1],
3558 pAdapter->CommonCfg.DesireRate[2],pAdapter->CommonCfg.DesireRate[3],
3559 pAdapter->CommonCfg.DesireRate[4],pAdapter->CommonCfg.DesireRate[5],
3560 pAdapter->CommonCfg.DesireRate[6],pAdapter->CommonCfg.DesireRate[7] ));
3561 // Changing DesiredRate may affect the MAX TX rate we used to TX frames out
3562 MlmeUpdateTxRates(pAdapter, FALSE, 0);
3563 }
3564 break;
3565 case RT_OID_802_11_PREAMBLE:
3566 if (wrq->u.data.length != sizeof(RT_802_11_PREAMBLE))
3567 Status = -EINVAL;
3568 else
3569 {
3570 Status = copy_from_user(&Preamble, wrq->u.data.pointer, wrq->u.data.length);
3571 if (Preamble == Rt802_11PreambleShort)
3572 {
3573 pAdapter->CommonCfg.TxPreamble = Preamble;
3574 MlmeSetTxPreamble(pAdapter, Rt802_11PreambleShort);
3575 }
3576 else if ((Preamble == Rt802_11PreambleLong) || (Preamble == Rt802_11PreambleAuto))
3577 {
3578 // if user wants AUTO, initialize to LONG here, then change according to AP's
3579 // capability upon association.
3580 pAdapter->CommonCfg.TxPreamble = Preamble;
3581 MlmeSetTxPreamble(pAdapter, Rt802_11PreambleLong);
3582 }
3583 else
3584 {
3585 Status = -EINVAL;
3586 break;
3587 }
3588 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_PREAMBLE (=%d)\n", Preamble));
3589 }
3590 break;
3591 case OID_802_11_WEP_STATUS:
3592 if (wrq->u.data.length != sizeof(NDIS_802_11_WEP_STATUS))
3593 Status = -EINVAL;
3594 else
3595 {
3596 Status = copy_from_user(&WepStatus, wrq->u.data.pointer, wrq->u.data.length);
3597 // Since TKIP, AES, WEP are all supported. It should not have any invalid setting
3598 if (WepStatus <= Ndis802_11Encryption3KeyAbsent)
3599 {
3600 if (pAdapter->StaCfg.WepStatus != WepStatus)
3601 {
3602 // Config has changed
3603 pAdapter->bConfigChanged = TRUE;
3604 }
3605 pAdapter->StaCfg.WepStatus = WepStatus;
3606 pAdapter->StaCfg.OrigWepStatus = WepStatus;
3607 pAdapter->StaCfg.PairCipher = WepStatus;
3608 pAdapter->StaCfg.GroupCipher = WepStatus;
3609 }
3610 else
3611 {
3612 Status = -EINVAL;
3613 break;
3614 }
3615 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEP_STATUS (=%d)\n",WepStatus));
3616 }
3617 break;
3618 case OID_802_11_AUTHENTICATION_MODE:
3619 if (wrq->u.data.length != sizeof(NDIS_802_11_AUTHENTICATION_MODE))
3620 Status = -EINVAL;
3621 else
3622 {
3623 Status = copy_from_user(&AuthMode, wrq->u.data.pointer, wrq->u.data.length);
3624 if (AuthMode > Ndis802_11AuthModeMax)
3625 {
3626 Status = -EINVAL;
3627 break;
3628 }
3629 else
3630 {
3631 if (pAdapter->StaCfg.AuthMode != AuthMode)
3632 {
3633 // Config has changed
3634 pAdapter->bConfigChanged = TRUE;
3635 }
3636 pAdapter->StaCfg.AuthMode = AuthMode;
3637 }
3638 pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
3639 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_AUTHENTICATION_MODE (=%d) \n",pAdapter->StaCfg.AuthMode));
3640 }
3641 break;
3642 case OID_802_11_INFRASTRUCTURE_MODE:
3643 if (wrq->u.data.length != sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE))
3644 Status = -EINVAL;
3645 else
3646 {
3647 Status = copy_from_user(&BssType, wrq->u.data.pointer, wrq->u.data.length);
3648
3649 if (BssType == Ndis802_11IBSS)
3650 Set_NetworkType_Proc(pAdapter, "Adhoc");
3651 else if (BssType == Ndis802_11Infrastructure)
3652 Set_NetworkType_Proc(pAdapter, "Infra");
3653 else if (BssType == Ndis802_11Monitor)
3654 Set_NetworkType_Proc(pAdapter, "Monitor");
3655 else
3656 {
3657 Status = -EINVAL;
3658 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_INFRASTRUCTURE_MODE (unknown)\n"));
3659 }
3660 }
3661 break;
3662 case OID_802_11_REMOVE_WEP:
3663 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_WEP\n"));
3664 if (wrq->u.data.length != sizeof(NDIS_802_11_KEY_INDEX))
3665 {
3666 Status = -EINVAL;
3667 }
3668 else
3669 {
3670 KeyIdx = *(NDIS_802_11_KEY_INDEX *) wrq->u.data.pointer;
3671
3672 if (KeyIdx & 0x80000000)
3673 {
3674 // Should never set default bit when remove key
3675 Status = -EINVAL;
3676 }
3677 else
3678 {
3679 KeyIdx = KeyIdx & 0x0fffffff;
3680 if (KeyIdx >= 4){
3681 Status = -EINVAL;
3682 }
3683 else
3684 {
3685 pAdapter->SharedKey[BSS0][KeyIdx].KeyLen = 0;
3686 pAdapter->SharedKey[BSS0][KeyIdx].CipherAlg = CIPHER_NONE;
3687 AsicRemoveSharedKeyEntry(pAdapter, 0, (UCHAR)KeyIdx);
3688 }
3689 }
3690 }
3691 break;
3692 case RT_OID_802_11_RESET_COUNTERS:
3693 NdisZeroMemory(&pAdapter->WlanCounters, sizeof(COUNTER_802_11));
3694 NdisZeroMemory(&pAdapter->Counters8023, sizeof(COUNTER_802_3));
3695 NdisZeroMemory(&pAdapter->RalinkCounters, sizeof(COUNTER_RALINK));
3696 pAdapter->Counters8023.RxNoBuffer = 0;
3697 pAdapter->Counters8023.GoodReceives = 0;
3698 pAdapter->Counters8023.RxNoBuffer = 0;
3699 #ifdef RT2870
3700 pAdapter->BulkOutComplete = 0;
3701 pAdapter->BulkOutCompleteOther= 0;
3702 pAdapter->BulkOutCompleteCancel = 0;
3703 pAdapter->BulkOutReq = 0;
3704 pAdapter->BulkInReq= 0;
3705 pAdapter->BulkInComplete = 0;
3706 pAdapter->BulkInCompleteFail = 0;
3707 #endif // RT2870 //
3708 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_RESET_COUNTERS \n"));
3709 break;
3710 case OID_802_11_RTS_THRESHOLD:
3711 if (wrq->u.data.length != sizeof(NDIS_802_11_RTS_THRESHOLD))
3712 Status = -EINVAL;
3713 else
3714 {
3715 Status = copy_from_user(&RtsThresh, wrq->u.data.pointer, wrq->u.data.length);
3716 if (RtsThresh > MAX_RTS_THRESHOLD)
3717 Status = -EINVAL;
3718 else
3719 pAdapter->CommonCfg.RtsThreshold = (USHORT)RtsThresh;
3720 }
3721 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_RTS_THRESHOLD (=%ld)\n",RtsThresh));
3722 break;
3723 case OID_802_11_FRAGMENTATION_THRESHOLD:
3724 if (wrq->u.data.length != sizeof(NDIS_802_11_FRAGMENTATION_THRESHOLD))
3725 Status = -EINVAL;
3726 else
3727 {
3728 Status = copy_from_user(&FragThresh, wrq->u.data.pointer, wrq->u.data.length);
3729 pAdapter->CommonCfg.bUseZeroToDisableFragment = FALSE;
3730 if (FragThresh > MAX_FRAG_THRESHOLD || FragThresh < MIN_FRAG_THRESHOLD)
3731 {
3732 if (FragThresh == 0)
3733 {
3734 pAdapter->CommonCfg.FragmentThreshold = MAX_FRAG_THRESHOLD;
3735 pAdapter->CommonCfg.bUseZeroToDisableFragment = TRUE;
3736 }
3737 else
3738 Status = -EINVAL;
3739 }
3740 else
3741 pAdapter->CommonCfg.FragmentThreshold = (USHORT)FragThresh;
3742 }
3743 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_FRAGMENTATION_THRESHOLD (=%ld) \n",FragThresh));
3744 break;
3745 case OID_802_11_POWER_MODE:
3746 if (wrq->u.data.length != sizeof(NDIS_802_11_POWER_MODE))
3747 Status = -EINVAL;
3748 else
3749 {
3750 Status = copy_from_user(&PowerMode, wrq->u.data.pointer, wrq->u.data.length);
3751 if (PowerMode == Ndis802_11PowerModeCAM)
3752 Set_PSMode_Proc(pAdapter, "CAM");
3753 else if (PowerMode == Ndis802_11PowerModeMAX_PSP)
3754 Set_PSMode_Proc(pAdapter, "Max_PSP");
3755 else if (PowerMode == Ndis802_11PowerModeFast_PSP)
3756 Set_PSMode_Proc(pAdapter, "Fast_PSP");
3757 else if (PowerMode == Ndis802_11PowerModeLegacy_PSP)
3758 Set_PSMode_Proc(pAdapter, "Legacy_PSP");
3759 else
3760 Status = -EINVAL;
3761 }
3762 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_POWER_MODE (=%d)\n",PowerMode));
3763 break;
3764 case RT_OID_802_11_TX_POWER_LEVEL_1:
3765 if (wrq->u.data.length < sizeof(ULONG))
3766 Status = -EINVAL;
3767 else
3768 {
3769 Status = copy_from_user(&PowerTemp, wrq->u.data.pointer, wrq->u.data.length);
3770 if (PowerTemp > 100)
3771 PowerTemp = 0xffffffff; // AUTO
3772 pAdapter->CommonCfg.TxPowerDefault = PowerTemp; //keep current setting.
3773 pAdapter->CommonCfg.TxPowerPercentage = pAdapter->CommonCfg.TxPowerDefault;
3774 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_TX_POWER_LEVEL_1 (=%ld)\n", pAdapter->CommonCfg.TxPowerPercentage));
3775 }
3776 break;
3777 case OID_802_11_NETWORK_TYPE_IN_USE:
3778 if (wrq->u.data.length != sizeof(NDIS_802_11_NETWORK_TYPE))
3779 Status = -EINVAL;
3780 else
3781 {
3782 Status = copy_from_user(&NetType, wrq->u.data.pointer, wrq->u.data.length);
3783
3784 if (NetType == Ndis802_11DS)
3785 RTMPSetPhyMode(pAdapter, PHY_11B);
3786 else if (NetType == Ndis802_11OFDM24)
3787 RTMPSetPhyMode(pAdapter, PHY_11BG_MIXED);
3788 else if (NetType == Ndis802_11OFDM5)
3789 RTMPSetPhyMode(pAdapter, PHY_11A);
3790 else
3791 Status = -EINVAL;
3792 #ifdef DOT11_N_SUPPORT
3793 if (Status == NDIS_STATUS_SUCCESS)
3794 SetCommonHT(pAdapter);
3795 #endif // DOT11_N_SUPPORT //
3796 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_NETWORK_TYPE_IN_USE (=%d)\n",NetType));
3797 }
3798 break;
3799 // For WPA PSK PMK key
3800 case RT_OID_802_11_ADD_WPA:
3801 pKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
3802 if(pKey == NULL)
3803 {
3804 Status = -ENOMEM;
3805 break;
3806 }
3807
3808 Status = copy_from_user(pKey, wrq->u.data.pointer, wrq->u.data.length);
3809 if (pKey->Length != wrq->u.data.length)
3810 {
3811 Status = -EINVAL;
3812 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA, Failed!!\n"));
3813 }
3814 else
3815 {
3816 if ((pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPAPSK) &&
3817 (pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPA2PSK) &&
3818 (pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPANone) )
3819 {
3820 Status = -EOPNOTSUPP;
3821 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA, Failed!! [AuthMode != WPAPSK/WPA2PSK/WPANONE]\n"));
3822 }
3823 else if ((pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPAPSK) ||
3824 (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPA2PSK) ||
3825 (pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPANone) ) // Only for WPA PSK mode
3826 {
3827 NdisMoveMemory(pAdapter->StaCfg.PMK, &pKey->KeyMaterial, pKey->KeyLength);
3828 // Use RaConfig as PSK agent.
3829 // Start STA supplicant state machine
3830 if (pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPANone)
3831 pAdapter->StaCfg.WpaState = SS_START;
3832
3833 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA (id=0x%x, Len=%d-byte)\n", pKey->KeyIndex, pKey->KeyLength));
3834 }
3835 else
3836 {
3837 pAdapter->StaCfg.WpaState = SS_NOTUSE;
3838 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_WPA (id=0x%x, Len=%d-byte)\n", pKey->KeyIndex, pKey->KeyLength));
3839 }
3840 }
3841 kfree(pKey);
3842 break;
3843 case OID_802_11_REMOVE_KEY:
3844 pRemoveKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
3845 if(pRemoveKey == NULL)
3846 {
3847 Status = -ENOMEM;
3848 break;
3849 }
3850
3851 Status = copy_from_user(pRemoveKey, wrq->u.data.pointer, wrq->u.data.length);
3852 if (pRemoveKey->Length != wrq->u.data.length)
3853 {
3854 Status = -EINVAL;
3855 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Failed!!\n"));
3856 }
3857 else
3858 {
3859 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
3860 {
3861 RTMPWPARemoveKeyProc(pAdapter, pRemoveKey);
3862 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Remove WPA Key!!\n"));
3863 }
3864 else
3865 {
3866 KeyIdx = pRemoveKey->KeyIndex;
3867
3868 if (KeyIdx & 0x80000000)
3869 {
3870 // Should never set default bit when remove key
3871 Status = -EINVAL;
3872 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Failed!!(Should never set default bit when remove key)\n"));
3873 }
3874 else
3875 {
3876 KeyIdx = KeyIdx & 0x0fffffff;
3877 if (KeyIdx > 3)
3878 {
3879 Status = -EINVAL;
3880 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY, Failed!!(KeyId[%d] out of range)\n", KeyIdx));
3881 }
3882 else
3883 {
3884 pAdapter->SharedKey[BSS0][KeyIdx].KeyLen = 0;
3885 pAdapter->SharedKey[BSS0][KeyIdx].CipherAlg = CIPHER_NONE;
3886 AsicRemoveSharedKeyEntry(pAdapter, 0, (UCHAR)KeyIdx);
3887 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_REMOVE_KEY (id=0x%x, Len=%d-byte)\n", pRemoveKey->KeyIndex, pRemoveKey->Length));
3888 }
3889 }
3890 }
3891 }
3892 kfree(pRemoveKey);
3893 break;
3894 // New for WPA
3895 case OID_802_11_ADD_KEY:
3896 pKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
3897 if(pKey == NULL)
3898 {
3899 Status = -ENOMEM;
3900 break;
3901 }
3902 Status = copy_from_user(pKey, wrq->u.data.pointer, wrq->u.data.length);
3903 if (pKey->Length != wrq->u.data.length)
3904 {
3905 Status = -EINVAL;
3906 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_KEY, Failed!!\n"));
3907 }
3908 else
3909 {
3910 RTMPAddKey(pAdapter, pKey);
3911 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_KEY (id=0x%x, Len=%d-byte)\n", pKey->KeyIndex, pKey->KeyLength));
3912 }
3913 kfree(pKey);
3914 break;
3915 case OID_802_11_CONFIGURATION:
3916 if (wrq->u.data.length != sizeof(NDIS_802_11_CONFIGURATION))
3917 Status = -EINVAL;
3918 else
3919 {
3920 Status = copy_from_user(&Config, wrq->u.data.pointer, wrq->u.data.length);
3921 pConfig = &Config;
3922
3923 if ((pConfig->BeaconPeriod >= 20) && (pConfig->BeaconPeriod <=400))
3924 pAdapter->CommonCfg.BeaconPeriod = (USHORT) pConfig->BeaconPeriod;
3925
3926 pAdapter->StaActive.AtimWin = (USHORT) pConfig->ATIMWindow;
3927 MAP_KHZ_TO_CHANNEL_ID(pConfig->DSConfig, pAdapter->CommonCfg.Channel);
3928 //
3929 // Save the channel on MlmeAux for CntlOidRTBssidProc used.
3930 //
3931 pAdapter->MlmeAux.Channel = pAdapter->CommonCfg.Channel;
3932
3933 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_CONFIGURATION (BeacnPeriod=%ld,AtimW=%ld,Ch=%d)\n",
3934 pConfig->BeaconPeriod, pConfig->ATIMWindow, pAdapter->CommonCfg.Channel));
3935 // Config has changed
3936 pAdapter->bConfigChanged = TRUE;
3937 }
3938 break;
3939 #ifdef DOT11_N_SUPPORT
3940 case RT_OID_802_11_SET_HT_PHYMODE:
3941 if (wrq->u.data.length != sizeof(OID_SET_HT_PHYMODE))
3942 Status = -EINVAL;
3943 else
3944 {
3945 POID_SET_HT_PHYMODE pHTPhyMode = &HT_PhyMode;
3946
3947 Status = copy_from_user(&HT_PhyMode, wrq->u.data.pointer, wrq->u.data.length);
3948 DBGPRINT(RT_DEBUG_TRACE, ("Set::pHTPhyMode (PhyMode = %d,TransmitNo = %d, HtMode = %d, ExtOffset = %d , MCS = %d, BW = %d, STBC = %d, SHORTGI = %d) \n",
3949 pHTPhyMode->PhyMode, pHTPhyMode->TransmitNo,pHTPhyMode->HtMode,pHTPhyMode->ExtOffset,
3950 pHTPhyMode->MCS, pHTPhyMode->BW, pHTPhyMode->STBC, pHTPhyMode->SHORTGI));
3951 if (pAdapter->CommonCfg.PhyMode >= PHY_11ABGN_MIXED)
3952 RTMPSetHT(pAdapter, pHTPhyMode);
3953 }
3954 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_HT_PHYMODE(MCS=%d,BW=%d,SGI=%d,STBC=%d)\n",
3955 pAdapter->StaCfg.HTPhyMode.field.MCS, pAdapter->StaCfg.HTPhyMode.field.BW, pAdapter->StaCfg.HTPhyMode.field.ShortGI,
3956 pAdapter->StaCfg.HTPhyMode.field.STBC));
3957 break;
3958 #endif // DOT11_N_SUPPORT //
3959 case RT_OID_802_11_SET_APSD_SETTING:
3960 if (wrq->u.data.length != sizeof(ULONG))
3961 Status = -EINVAL;
3962 else
3963 {
3964 ULONG apsd ;
3965 Status = copy_from_user(&apsd, wrq->u.data.pointer, wrq->u.data.length);
3966
3967 /*-------------------------------------------------------------------
3968 |B31~B7 | B6~B5 | B4 | B3 | B2 | B1 | B0 |
3969 ---------------------------------------------------------------------
3970 | Rsvd | Max SP Len | AC_VO | AC_VI | AC_BK | AC_BE | APSD Capable |
3971 ---------------------------------------------------------------------*/
3972 pAdapter->CommonCfg.bAPSDCapable = (apsd & 0x00000001) ? TRUE : FALSE;
3973 pAdapter->CommonCfg.bAPSDAC_BE = ((apsd & 0x00000002) >> 1) ? TRUE : FALSE;
3974 pAdapter->CommonCfg.bAPSDAC_BK = ((apsd & 0x00000004) >> 2) ? TRUE : FALSE;
3975 pAdapter->CommonCfg.bAPSDAC_VI = ((apsd & 0x00000008) >> 3) ? TRUE : FALSE;
3976 pAdapter->CommonCfg.bAPSDAC_VO = ((apsd & 0x00000010) >> 4) ? TRUE : FALSE;
3977 pAdapter->CommonCfg.MaxSPLength = (UCHAR)((apsd & 0x00000060) >> 5);
3978
3979 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_APSD_SETTING (apsd=0x%lx, APSDCap=%d, [BE,BK,VI,VO]=[%d/%d/%d/%d], MaxSPLen=%d)\n", apsd, pAdapter->CommonCfg.bAPSDCapable,
3980 pAdapter->CommonCfg.bAPSDAC_BE, pAdapter->CommonCfg.bAPSDAC_BK, pAdapter->CommonCfg.bAPSDAC_VI, pAdapter->CommonCfg.bAPSDAC_VO, pAdapter->CommonCfg.MaxSPLength));
3981 }
3982 break;
3983
3984 case RT_OID_802_11_SET_APSD_PSM:
3985 if (wrq->u.data.length != sizeof(ULONG))
3986 Status = -EINVAL;
3987 else
3988 {
3989 // Driver needs to notify AP when PSM changes
3990 Status = copy_from_user(&pAdapter->CommonCfg.bAPSDForcePowerSave, wrq->u.data.pointer, wrq->u.data.length);
3991 if (pAdapter->CommonCfg.bAPSDForcePowerSave != pAdapter->StaCfg.Psm)
3992 {
3993 MlmeSetPsmBit(pAdapter, pAdapter->CommonCfg.bAPSDForcePowerSave);
3994 RTMPSendNullFrame(pAdapter, pAdapter->CommonCfg.TxRate, TRUE);
3995 }
3996 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_APSD_PSM (bAPSDForcePowerSave:%d)\n", pAdapter->CommonCfg.bAPSDForcePowerSave));
3997 }
3998 break;
3999 #ifdef QOS_DLS_SUPPORT
4000 case RT_OID_802_11_SET_DLS:
4001 if (wrq->u.data.length != sizeof(ULONG))
4002 Status = -EINVAL;
4003 else
4004 {
4005 BOOLEAN oldvalue = pAdapter->CommonCfg.bDLSCapable;
4006 Status = copy_from_user(&pAdapter->CommonCfg.bDLSCapable, wrq->u.data.pointer, wrq->u.data.length);
4007 if (oldvalue && !pAdapter->CommonCfg.bDLSCapable)
4008 {
4009 int i;
4010 // tear down local dls table entry
4011 for (i=0; i<MAX_NUM_OF_INIT_DLS_ENTRY; i++)
4012 {
4013 if (pAdapter->StaCfg.DLSEntry[i].Valid && (pAdapter->StaCfg.DLSEntry[i].Status == DLS_FINISH))
4014 {
4015 pAdapter->StaCfg.DLSEntry[i].Status = DLS_NONE;
4016 pAdapter->StaCfg.DLSEntry[i].Valid = FALSE;
4017 RTMPSendDLSTearDownFrame(pAdapter, pAdapter->StaCfg.DLSEntry[i].MacAddr);
4018 }
4019 }
4020
4021 // tear down peer dls table entry
4022 for (i=MAX_NUM_OF_INIT_DLS_ENTRY; i<MAX_NUM_OF_DLS_ENTRY; i++)
4023 {
4024 if (pAdapter->StaCfg.DLSEntry[i].Valid && (pAdapter->StaCfg.DLSEntry[i].Status == DLS_FINISH))
4025 {
4026 pAdapter->StaCfg.DLSEntry[i].Status = DLS_NONE;
4027 pAdapter->StaCfg.DLSEntry[i].Valid = FALSE;
4028 RTMPSendDLSTearDownFrame(pAdapter, pAdapter->StaCfg.DLSEntry[i].MacAddr);
4029 }
4030 }
4031 }
4032
4033 DBGPRINT(RT_DEBUG_TRACE,("Set::RT_OID_802_11_SET_DLS (=%d)\n", pAdapter->CommonCfg.bDLSCapable));
4034 }
4035 break;
4036
4037 case RT_OID_802_11_SET_DLS_PARAM:
4038 if (wrq->u.data.length != sizeof(RT_802_11_DLS_UI))
4039 Status = -EINVAL;
4040 else
4041 {
4042 RT_802_11_DLS Dls;
4043
4044 NdisZeroMemory(&Dls, sizeof(RT_802_11_DLS));
4045 RTMPMoveMemory(&Dls, wrq->u.data.pointer, sizeof(RT_802_11_DLS_UI));
4046 MlmeEnqueue(pAdapter,
4047 MLME_CNTL_STATE_MACHINE,
4048 RT_OID_802_11_SET_DLS_PARAM,
4049 sizeof(RT_802_11_DLS),
4050 &Dls);
4051 DBGPRINT(RT_DEBUG_TRACE,("Set::RT_OID_802_11_SET_DLS_PARAM \n"));
4052 }
4053 break;
4054 #endif // QOS_DLS_SUPPORT //
4055 case RT_OID_802_11_SET_WMM:
4056 if (wrq->u.data.length != sizeof(BOOLEAN))
4057 Status = -EINVAL;
4058 else
4059 {
4060 Status = copy_from_user(&pAdapter->CommonCfg.bWmmCapable, wrq->u.data.pointer, wrq->u.data.length);
4061 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_SET_WMM (=%d) \n", pAdapter->CommonCfg.bWmmCapable));
4062 }
4063 break;
4064
4065 case OID_802_11_DISASSOCIATE:
4066 #ifdef RALINK_ATE
4067 if (ATE_ON(pAdapter))
4068 {
4069 DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n"));
4070 break;
4071 }
4072 #endif // RALINK_ATE //
4073 //
4074 // Set NdisRadioStateOff to TRUE, instead of called MlmeRadioOff.
4075 // Later on, NDIS_802_11_BSSID_LIST_EX->NumberOfItems should be 0
4076 // when query OID_802_11_BSSID_LIST.
4077 //
4078 // TRUE: NumberOfItems will set to 0.
4079 // FALSE: NumberOfItems no change.
4080 //
4081 pAdapter->CommonCfg.NdisRadioStateOff = TRUE;
4082 // Set to immediately send the media disconnect event
4083 pAdapter->MlmeAux.CurrReqIsFromNdis = TRUE;
4084 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DISASSOCIATE \n"));
4085
4086 if (INFRA_ON(pAdapter))
4087 {
4088 if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
4089 {
4090 RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
4091 DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
4092 }
4093
4094 MlmeEnqueue(pAdapter,
4095 MLME_CNTL_STATE_MACHINE,
4096 OID_802_11_DISASSOCIATE,
4097 0,
4098 NULL);
4099
4100 StateMachineTouched = TRUE;
4101 }
4102 break;
4103
4104 #ifdef DOT11_N_SUPPORT
4105 case RT_OID_802_11_SET_IMME_BA_CAP:
4106 if (wrq->u.data.length != sizeof(OID_BACAP_STRUC))
4107 Status = -EINVAL;
4108 else
4109 {
4110 OID_BACAP_STRUC Orde ;
4111 Status = copy_from_user(&Orde, wrq->u.data.pointer, wrq->u.data.length);
4112 if (Orde.Policy > BA_NOTUSE)
4113 {
4114 Status = NDIS_STATUS_INVALID_DATA;
4115 }
4116 else if (Orde.Policy == BA_NOTUSE)
4117 {
4118 pAdapter->CommonCfg.BACapability.field.Policy = BA_NOTUSE;
4119 pAdapter->CommonCfg.BACapability.field.MpduDensity = Orde.MpduDensity;
4120 pAdapter->CommonCfg.DesiredHtPhy.MpduDensity = Orde.MpduDensity;
4121 pAdapter->CommonCfg.DesiredHtPhy.AmsduEnable = Orde.AmsduEnable;
4122 pAdapter->CommonCfg.DesiredHtPhy.AmsduSize= Orde.AmsduSize;
4123 pAdapter->CommonCfg.DesiredHtPhy.MimoPs= Orde.MMPSmode;
4124 pAdapter->CommonCfg.BACapability.field.MMPSmode = Orde.MMPSmode;
4125 // UPdata to HT IE
4126 pAdapter->CommonCfg.HtCapability.HtCapInfo.MimoPs = Orde.MMPSmode;
4127 pAdapter->CommonCfg.HtCapability.HtCapInfo.AMsduSize = Orde.AmsduSize;
4128 pAdapter->CommonCfg.HtCapability.HtCapParm.MpduDensity = Orde.MpduDensity;
4129 }
4130 else
4131 {
4132 pAdapter->CommonCfg.BACapability.field.AutoBA = Orde.AutoBA;
4133 pAdapter->CommonCfg.BACapability.field.Policy = IMMED_BA; // we only support immediate BA.
4134 pAdapter->CommonCfg.BACapability.field.MpduDensity = Orde.MpduDensity;
4135 pAdapter->CommonCfg.DesiredHtPhy.MpduDensity = Orde.MpduDensity;
4136 pAdapter->CommonCfg.DesiredHtPhy.AmsduEnable = Orde.AmsduEnable;
4137 pAdapter->CommonCfg.DesiredHtPhy.AmsduSize= Orde.AmsduSize;
4138 pAdapter->CommonCfg.DesiredHtPhy.MimoPs = Orde.MMPSmode;
4139 pAdapter->CommonCfg.BACapability.field.MMPSmode = Orde.MMPSmode;
4140
4141 // UPdata to HT IE
4142 pAdapter->CommonCfg.HtCapability.HtCapInfo.MimoPs = Orde.MMPSmode;
4143 pAdapter->CommonCfg.HtCapability.HtCapInfo.AMsduSize = Orde.AmsduSize;
4144 pAdapter->CommonCfg.HtCapability.HtCapParm.MpduDensity = Orde.MpduDensity;
4145
4146 if (pAdapter->CommonCfg.BACapability.field.RxBAWinLimit > MAX_RX_REORDERBUF)
4147 pAdapter->CommonCfg.BACapability.field.RxBAWinLimit = MAX_RX_REORDERBUF;
4148
4149 }
4150
4151 pAdapter->CommonCfg.REGBACapability.word = pAdapter->CommonCfg.BACapability.word;
4152 DBGPRINT(RT_DEBUG_TRACE, ("Set::(Orde.AutoBA = %d) (Policy=%d)(ReBAWinLimit=%d)(TxBAWinLimit=%d)(AutoMode=%d)\n",Orde.AutoBA, pAdapter->CommonCfg.BACapability.field.Policy,
4153 pAdapter->CommonCfg.BACapability.field.RxBAWinLimit,pAdapter->CommonCfg.BACapability.field.TxBAWinLimit, pAdapter->CommonCfg.BACapability.field.AutoBA));
4154 DBGPRINT(RT_DEBUG_TRACE, ("Set::(MimoPs = %d)(AmsduEnable = %d) (AmsduSize=%d)(MpduDensity=%d)\n",pAdapter->CommonCfg.DesiredHtPhy.MimoPs, pAdapter->CommonCfg.DesiredHtPhy.AmsduEnable,
4155 pAdapter->CommonCfg.DesiredHtPhy.AmsduSize, pAdapter->CommonCfg.DesiredHtPhy.MpduDensity));
4156 }
4157
4158 break;
4159 case RT_OID_802_11_ADD_IMME_BA:
4160 DBGPRINT(RT_DEBUG_TRACE, (" Set :: RT_OID_802_11_ADD_IMME_BA \n"));
4161 if (wrq->u.data.length != sizeof(OID_ADD_BA_ENTRY))
4162 Status = -EINVAL;
4163 else
4164 {
4165 UCHAR index;
4166 OID_ADD_BA_ENTRY BA;
4167 MAC_TABLE_ENTRY *pEntry;
4168
4169 Status = copy_from_user(&BA, wrq->u.data.pointer, wrq->u.data.length);
4170 if (BA.TID > 15)
4171 {
4172 Status = NDIS_STATUS_INVALID_DATA;
4173 break;
4174 }
4175 else
4176 {
4177 //BATableInsertEntry
4178 //As ad-hoc mode, BA pair is not limited to only BSSID. so add via OID.
4179 index = BA.TID;
4180 // in ad hoc mode, when adding BA pair, we should insert this entry into MACEntry too
4181 pEntry = MacTableLookup(pAdapter, BA.MACAddr);
4182 if (!pEntry)
4183 {
4184 DBGPRINT(RT_DEBUG_TRACE, ("RT_OID_802_11_ADD_IMME_BA. break on no connection.----:%x:%x\n", BA.MACAddr[4], BA.MACAddr[5]));
4185 break;
4186 }
4187 if (BA.IsRecipient == FALSE)
4188 {
4189 if (pEntry->bIAmBadAtheros == TRUE)
4190 pAdapter->CommonCfg.BACapability.field.RxBAWinLimit = 0x10;
4191
4192 BAOriSessionSetUp(pAdapter, pEntry, index, 0, 100, TRUE);
4193 }
4194 else
4195 {
4196 //BATableInsertEntry(pAdapter, pEntry->Aid, BA.MACAddr, 0, 0xffff, BA.TID, BA.nMSDU, BA.IsRecipient);
4197 }
4198
4199 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_802_11_ADD_IMME_BA. Rec = %d. Mac = %x:%x:%x:%x:%x:%x . \n",
4200 BA.IsRecipient, BA.MACAddr[0], BA.MACAddr[1], BA.MACAddr[2], BA.MACAddr[2]
4201 , BA.MACAddr[4], BA.MACAddr[5]));
4202 }
4203 }
4204 break;
4205
4206 case RT_OID_802_11_TEAR_IMME_BA:
4207 DBGPRINT(RT_DEBUG_TRACE, ("Set :: RT_OID_802_11_TEAR_IMME_BA \n"));
4208 if (wrq->u.data.length != sizeof(OID_ADD_BA_ENTRY))
4209 Status = -EINVAL;
4210 else
4211 {
4212 POID_ADD_BA_ENTRY pBA;
4213 MAC_TABLE_ENTRY *pEntry;
4214
4215 pBA = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
4216
4217 if (pBA == NULL)
4218 {
4219 DBGPRINT(RT_DEBUG_TRACE, ("Set :: RT_OID_802_11_TEAR_IMME_BA kmalloc() can't allocate enough memory\n"));
4220 Status = NDIS_STATUS_FAILURE;
4221 }
4222 else
4223 {
4224 Status = copy_from_user(pBA, wrq->u.data.pointer, wrq->u.data.length);
4225 DBGPRINT(RT_DEBUG_TRACE, ("Set :: RT_OID_802_11_TEAR_IMME_BA(TID=%d, bAllTid=%d)\n", pBA->TID, pBA->bAllTid));
4226
4227 if (!pBA->bAllTid && (pBA->TID > NUM_OF_TID))
4228 {
4229 Status = NDIS_STATUS_INVALID_DATA;
4230 break;
4231 }
4232
4233 if (pBA->IsRecipient == FALSE)
4234 {
4235 pEntry = MacTableLookup(pAdapter, pBA->MACAddr);
4236 DBGPRINT(RT_DEBUG_TRACE, (" pBA->IsRecipient == FALSE\n"));
4237 if (pEntry)
4238 {
4239 DBGPRINT(RT_DEBUG_TRACE, (" pBA->pEntry\n"));
4240 BAOriSessionTearDown(pAdapter, pEntry->Aid, pBA->TID, FALSE, TRUE);
4241 }
4242 else
4243 DBGPRINT(RT_DEBUG_TRACE, ("Set :: Not found pEntry \n"));
4244 }
4245 else
4246 {
4247 pEntry = MacTableLookup(pAdapter, pBA->MACAddr);
4248 if (pEntry)
4249 {
4250 BARecSessionTearDown( pAdapter, (UCHAR)pEntry->Aid, pBA->TID, TRUE);
4251 }
4252 else
4253 DBGPRINT(RT_DEBUG_TRACE, ("Set :: Not found pEntry \n"));
4254 }
4255 kfree(pBA);
4256 }
4257 }
4258 break;
4259 #endif // DOT11_N_SUPPORT //
4260
4261 // For WPA_SUPPLICANT to set static wep key
4262 case OID_802_11_ADD_WEP:
4263 pWepKey = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
4264
4265 if(pWepKey == NULL)
4266 {
4267 Status = -ENOMEM;
4268 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, Failed!!\n"));
4269 break;
4270 }
4271 Status = copy_from_user(pWepKey, wrq->u.data.pointer, wrq->u.data.length);
4272 if (Status)
4273 {
4274 Status = -EINVAL;
4275 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, Failed (length mismatch)!!\n"));
4276 }
4277 else
4278 {
4279 KeyIdx = pWepKey->KeyIndex & 0x0fffffff;
4280 // KeyIdx must be 0 ~ 3
4281 if (KeyIdx > 4)
4282 {
4283 Status = -EINVAL;
4284 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, Failed (KeyIdx must be smaller than 4)!!\n"));
4285 }
4286 else
4287 {
4288 UCHAR CipherAlg = 0;
4289 PUCHAR Key;
4290
4291 // set key material and key length
4292 NdisZeroMemory(pAdapter->SharedKey[BSS0][KeyIdx].Key, 16);
4293 pAdapter->SharedKey[BSS0][KeyIdx].KeyLen = (UCHAR) pWepKey->KeyLength;
4294 NdisMoveMemory(pAdapter->SharedKey[BSS0][KeyIdx].Key, &pWepKey->KeyMaterial, pWepKey->KeyLength);
4295
4296 switch(pWepKey->KeyLength)
4297 {
4298 case 5:
4299 CipherAlg = CIPHER_WEP64;
4300 break;
4301 case 13:
4302 CipherAlg = CIPHER_WEP128;
4303 break;
4304 default:
4305 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP, only support CIPHER_WEP64(len:5) & CIPHER_WEP128(len:13)!!\n"));
4306 Status = -EINVAL;
4307 break;
4308 }
4309 pAdapter->SharedKey[BSS0][KeyIdx].CipherAlg = CipherAlg;
4310
4311 // Default key for tx (shared key)
4312 if (pWepKey->KeyIndex & 0x80000000)
4313 {
4314 #ifdef WPA_SUPPLICANT_SUPPORT
4315 // set key material and key length
4316 NdisZeroMemory(pAdapter->StaCfg.DesireSharedKey[KeyIdx].Key, 16);
4317 pAdapter->StaCfg.DesireSharedKey[KeyIdx].KeyLen = (UCHAR) pWepKey->KeyLength;
4318 NdisMoveMemory(pAdapter->StaCfg.DesireSharedKey[KeyIdx].Key, &pWepKey->KeyMaterial, pWepKey->KeyLength);
4319 pAdapter->StaCfg.DesireSharedKeyId = KeyIdx;
4320 pAdapter->StaCfg.DesireSharedKey[KeyIdx].CipherAlg = CipherAlg;
4321 #endif // WPA_SUPPLICANT_SUPPORT //
4322 pAdapter->StaCfg.DefaultKeyId = (UCHAR) KeyIdx;
4323 }
4324
4325 #ifdef WPA_SUPPLICANT_SUPPORT
4326 if ((pAdapter->StaCfg.WpaSupplicantUP != WPA_SUPPLICANT_DISABLE) &&
4327 (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA))
4328 {
4329 Key = pWepKey->KeyMaterial;
4330
4331 // Set Group key material to Asic
4332 AsicAddSharedKeyEntry(pAdapter, BSS0, KeyIdx, CipherAlg, Key, NULL, NULL);
4333
4334 // Update WCID attribute table and IVEIV table for this group key table
4335 RTMPAddWcidAttributeEntry(pAdapter, BSS0, KeyIdx, CipherAlg, NULL);
4336
4337 STA_PORT_SECURED(pAdapter);
4338
4339 // Indicate Connected for GUI
4340 pAdapter->IndicateMediaState = NdisMediaStateConnected;
4341 }
4342 else if (pAdapter->StaCfg.PortSecured == WPA_802_1X_PORT_SECURED)
4343 #endif // WPA_SUPPLICANT_SUPPORT
4344 {
4345 Key = pAdapter->SharedKey[BSS0][KeyIdx].Key;
4346
4347 // Set key material and cipherAlg to Asic
4348 AsicAddSharedKeyEntry(pAdapter, BSS0, KeyIdx, CipherAlg, Key, NULL, NULL);
4349
4350 if (pWepKey->KeyIndex & 0x80000000)
4351 {
4352 PMAC_TABLE_ENTRY pEntry = &pAdapter->MacTab.Content[BSSID_WCID];
4353 // Assign group key info
4354 RTMPAddWcidAttributeEntry(pAdapter, BSS0, KeyIdx, CipherAlg, NULL);
4355 // Assign pairwise key info
4356 RTMPAddWcidAttributeEntry(pAdapter, BSS0, KeyIdx, CipherAlg, pEntry);
4357 }
4358 }
4359 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_ADD_WEP (id=0x%x, Len=%d-byte), %s\n", pWepKey->KeyIndex, pWepKey->KeyLength, (pAdapter->StaCfg.PortSecured == WPA_802_1X_PORT_SECURED) ? "Port Secured":"Port NOT Secured"));
4360 }
4361 }
4362 kfree(pWepKey);
4363 break;
4364 #ifdef WPA_SUPPLICANT_SUPPORT
4365 case OID_SET_COUNTERMEASURES:
4366 if (wrq->u.data.length != sizeof(int))
4367 Status = -EINVAL;
4368 else
4369 {
4370 int enabled = 0;
4371 Status = copy_from_user(&enabled, wrq->u.data.pointer, wrq->u.data.length);
4372 if (enabled == 1)
4373 pAdapter->StaCfg.bBlockAssoc = TRUE;
4374 else
4375 // WPA MIC error should block association attempt for 60 seconds
4376 pAdapter->StaCfg.bBlockAssoc = FALSE;
4377 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_SET_COUNTERMEASURES bBlockAssoc=%s\n", pAdapter->StaCfg.bBlockAssoc ? "TRUE":"FALSE"));
4378 }
4379 break;
4380 case RT_OID_WPA_SUPPLICANT_SUPPORT:
4381 if (wrq->u.data.length != sizeof(UCHAR))
4382 Status = -EINVAL;
4383 else
4384 {
4385 Status = copy_from_user(&wpa_supplicant_enable, wrq->u.data.pointer, wrq->u.data.length);
4386 pAdapter->StaCfg.WpaSupplicantUP = wpa_supplicant_enable;
4387 DBGPRINT(RT_DEBUG_TRACE, ("Set::RT_OID_WPA_SUPPLICANT_SUPPORT (=%d)\n", pAdapter->StaCfg.WpaSupplicantUP));
4388 }
4389 break;
4390 case OID_802_11_DEAUTHENTICATION:
4391 if (wrq->u.data.length != sizeof(MLME_DEAUTH_REQ_STRUCT))
4392 Status = -EINVAL;
4393 else
4394 {
4395 MLME_DEAUTH_REQ_STRUCT *pInfo;
4396 MLME_QUEUE_ELEM *MsgElem = (MLME_QUEUE_ELEM *) kmalloc(sizeof(MLME_QUEUE_ELEM), MEM_ALLOC_FLAG);
4397
4398 pInfo = (MLME_DEAUTH_REQ_STRUCT *) MsgElem->Msg;
4399 Status = copy_from_user(pInfo, wrq->u.data.pointer, wrq->u.data.length);
4400 MlmeDeauthReqAction(pAdapter, MsgElem);
4401 kfree(MsgElem);
4402
4403 if (INFRA_ON(pAdapter))
4404 {
4405 LinkDown(pAdapter, FALSE);
4406 pAdapter->Mlme.AssocMachine.CurrState = ASSOC_IDLE;
4407 }
4408 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DEAUTHENTICATION (Reason=%d)\n", pInfo->Reason));
4409 }
4410 break;
4411 case OID_802_11_DROP_UNENCRYPTED:
4412 if (wrq->u.data.length != sizeof(int))
4413 Status = -EINVAL;
4414 else
4415 {
4416 int enabled = 0;
4417 Status = copy_from_user(&enabled, wrq->u.data.pointer, wrq->u.data.length);
4418 if (enabled == 1)
4419 pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
4420 else
4421 pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_SECURED;
4422 NdisAcquireSpinLock(&pAdapter->MacTabLock);
4423 pAdapter->MacTab.Content[BSSID_WCID].PortSecured = pAdapter->StaCfg.PortSecured;
4424 NdisReleaseSpinLock(&pAdapter->MacTabLock);
4425 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_DROP_UNENCRYPTED (=%d)\n", enabled));
4426 }
4427 break;
4428 case OID_802_11_SET_IEEE8021X:
4429 if (wrq->u.data.length != sizeof(BOOLEAN))
4430 Status = -EINVAL;
4431 else
4432 {
4433 Status = copy_from_user(&IEEE8021xState, wrq->u.data.pointer, wrq->u.data.length);
4434 pAdapter->StaCfg.IEEE8021X = IEEE8021xState;
4435 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SET_IEEE8021X (=%d)\n", IEEE8021xState));
4436 }
4437 break;
4438 case OID_802_11_SET_IEEE8021X_REQUIRE_KEY:
4439 if (wrq->u.data.length != sizeof(BOOLEAN))
4440 Status = -EINVAL;
4441 else
4442 {
4443 Status = copy_from_user(&IEEE8021x_required_keys, wrq->u.data.pointer, wrq->u.data.length);
4444 pAdapter->StaCfg.IEEE8021x_required_keys = IEEE8021x_required_keys;
4445 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SET_IEEE8021X_REQUIRE_KEY (%d)\n", IEEE8021x_required_keys));
4446 }
4447 break;
4448 case OID_802_11_PMKID:
4449 pPmkId = kmalloc(wrq->u.data.length, MEM_ALLOC_FLAG);
4450
4451 if(pPmkId == NULL) {
4452 Status = -ENOMEM;
4453 break;
4454 }
4455 Status = copy_from_user(pPmkId, wrq->u.data.pointer, wrq->u.data.length);
4456
4457 // check the PMKID information
4458 if (pPmkId->BSSIDInfoCount == 0)
4459 NdisZeroMemory(pAdapter->StaCfg.SavedPMK, sizeof(BSSID_INFO)*PMKID_NO);
4460 else
4461 {
4462 PBSSID_INFO pBssIdInfo;
4463 UINT BssIdx;
4464 UINT CachedIdx;
4465
4466 for (BssIdx = 0; BssIdx < pPmkId->BSSIDInfoCount; BssIdx++)
4467 {
4468 // point to the indexed BSSID_INFO structure
4469 pBssIdInfo = (PBSSID_INFO) ((PUCHAR) pPmkId + 2 * sizeof(UINT) + BssIdx * sizeof(BSSID_INFO));
4470 // Find the entry in the saved data base.
4471 for (CachedIdx = 0; CachedIdx < pAdapter->StaCfg.SavedPMKNum; CachedIdx++)
4472 {
4473 // compare the BSSID
4474 if (NdisEqualMemory(pBssIdInfo->BSSID, pAdapter->StaCfg.SavedPMK[CachedIdx].BSSID, sizeof(NDIS_802_11_MAC_ADDRESS)))
4475 break;
4476 }
4477
4478 // Found, replace it
4479 if (CachedIdx < PMKID_NO)
4480 {
4481 DBGPRINT(RT_DEBUG_OFF, ("Update OID_802_11_PMKID, idx = %d\n", CachedIdx));
4482 NdisMoveMemory(&pAdapter->StaCfg.SavedPMK[CachedIdx], pBssIdInfo, sizeof(BSSID_INFO));
4483 pAdapter->StaCfg.SavedPMKNum++;
4484 }
4485 // Not found, replace the last one
4486 else
4487 {
4488 // Randomly replace one
4489 CachedIdx = (pBssIdInfo->BSSID[5] % PMKID_NO);
4490 DBGPRINT(RT_DEBUG_OFF, ("Update OID_802_11_PMKID, idx = %d\n", CachedIdx));
4491 NdisMoveMemory(&pAdapter->StaCfg.SavedPMK[CachedIdx], pBssIdInfo, sizeof(BSSID_INFO));
4492 }
4493 }
4494 }
4495 if(pPmkId)
4496 kfree(pPmkId);
4497 break;
4498 #endif // WPA_SUPPLICANT_SUPPORT //
4499
4500
4501
4502 #ifdef SNMP_SUPPORT
4503 case OID_802_11_SHORTRETRYLIMIT:
4504 if (wrq->u.data.length != sizeof(ULONG))
4505 Status = -EINVAL;
4506 else
4507 {
4508 Status = copy_from_user(&ShortRetryLimit, wrq->u.data.pointer, wrq->u.data.length);
4509 RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
4510 tx_rty_cfg.field.ShortRtyLimit = ShortRetryLimit;
4511 RTMP_IO_WRITE32(pAdapter, TX_RTY_CFG, tx_rty_cfg.word);
4512 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_SHORTRETRYLIMIT (tx_rty_cfg.field.ShortRetryLimit=%d, ShortRetryLimit=%ld)\n", tx_rty_cfg.field.ShortRtyLimit, ShortRetryLimit));
4513 }
4514 break;
4515
4516 case OID_802_11_LONGRETRYLIMIT:
4517 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_LONGRETRYLIMIT \n"));
4518 if (wrq->u.data.length != sizeof(ULONG))
4519 Status = -EINVAL;
4520 else
4521 {
4522 Status = copy_from_user(&LongRetryLimit, wrq->u.data.pointer, wrq->u.data.length);
4523 RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
4524 tx_rty_cfg.field.LongRtyLimit = LongRetryLimit;
4525 RTMP_IO_WRITE32(pAdapter, TX_RTY_CFG, tx_rty_cfg.word);
4526 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_LONGRETRYLIMIT (tx_rty_cfg.field.LongRetryLimit= %d,LongRetryLimit=%ld)\n", tx_rty_cfg.field.LongRtyLimit, LongRetryLimit));
4527 }
4528 break;
4529
4530 case OID_802_11_WEPDEFAULTKEYVALUE:
4531 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEPDEFAULTKEYVALUE\n"));
4532 pKey = kmalloc(wrq->u.data.length, GFP_KERNEL);
4533 Status = copy_from_user(pKey, wrq->u.data.pointer, wrq->u.data.length);
4534 //pKey = &WepKey;
4535
4536 if ( pKey->Length != wrq->u.data.length)
4537 {
4538 Status = -EINVAL;
4539 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEPDEFAULTKEYVALUE, Failed!!\n"));
4540 }
4541 KeyIdx = pKey->KeyIndex & 0x0fffffff;
4542 DBGPRINT(RT_DEBUG_TRACE,("pKey->KeyIndex =%d, pKey->KeyLength=%d\n", pKey->KeyIndex, pKey->KeyLength));
4543
4544 // it is a shared key
4545 if (KeyIdx > 4)
4546 Status = -EINVAL;
4547 else
4548 {
4549 pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].KeyLen = (UCHAR) pKey->KeyLength;
4550 NdisMoveMemory(&pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].Key, &pKey->KeyMaterial, pKey->KeyLength);
4551 if (pKey->KeyIndex & 0x80000000)
4552 {
4553 // Default key for tx (shared key)
4554 pAdapter->StaCfg.DefaultKeyId = (UCHAR) KeyIdx;
4555 }
4556 //RestartAPIsRequired = TRUE;
4557 }
4558 break;
4559
4560
4561 case OID_802_11_WEPDEFAULTKEYID:
4562 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_WEPDEFAULTKEYID \n"));
4563
4564 if (wrq->u.data.length != sizeof(UCHAR))
4565 Status = -EINVAL;
4566 else
4567 Status = copy_from_user(&pAdapter->StaCfg.DefaultKeyId, wrq->u.data.pointer, wrq->u.data.length);
4568
4569 break;
4570
4571
4572 case OID_802_11_CURRENTCHANNEL:
4573 DBGPRINT(RT_DEBUG_TRACE, ("Set::OID_802_11_CURRENTCHANNEL \n"));
4574 if (wrq->u.data.length != sizeof(UCHAR))
4575 Status = -EINVAL;
4576 else
4577 {
4578 Status = copy_from_user(&ctmp, wrq->u.data.pointer, wrq->u.data.length);
4579 sprintf(&ctmp,"%d", ctmp);
4580 Set_Channel_Proc(pAdapter, &ctmp);
4581 }
4582 break;
4583 #endif
4584
4585
4586
4587 default:
4588 DBGPRINT(RT_DEBUG_TRACE, ("Set::unknown IOCTL's subcmd = 0x%08x\n", cmd));
4589 Status = -EOPNOTSUPP;
4590 break;
4591 }
4592
4593
4594 return Status;
4595 }
4596
4597 INT RTMPQueryInformation(
4598 IN PRTMP_ADAPTER pAdapter,
4599 IN OUT struct ifreq *rq,
4600 IN INT cmd)
4601 {
4602 struct iwreq *wrq = (struct iwreq *) rq;
4603 NDIS_802_11_BSSID_LIST_EX *pBssidList = NULL;
4604 PNDIS_WLAN_BSSID_EX pBss;
4605 NDIS_802_11_SSID Ssid;
4606 NDIS_802_11_CONFIGURATION *pConfiguration = NULL;
4607 RT_802_11_LINK_STATUS *pLinkStatus = NULL;
4608 RT_802_11_STA_CONFIG *pStaConfig = NULL;
4609 NDIS_802_11_STATISTICS *pStatistics = NULL;
4610 NDIS_802_11_RTS_THRESHOLD RtsThresh;
4611 NDIS_802_11_FRAGMENTATION_THRESHOLD FragThresh;
4612 NDIS_802_11_POWER_MODE PowerMode;
4613 NDIS_802_11_NETWORK_INFRASTRUCTURE BssType;
4614 RT_802_11_PREAMBLE PreamType;
4615 NDIS_802_11_AUTHENTICATION_MODE AuthMode;
4616 NDIS_802_11_WEP_STATUS WepStatus;
4617 NDIS_MEDIA_STATE MediaState;
4618 ULONG BssBufSize, ulInfo=0, NetworkTypeList[4], apsd = 0;
4619 USHORT BssLen = 0;
4620 PUCHAR pBuf = NULL, pPtr;
4621 INT Status = NDIS_STATUS_SUCCESS;
4622 UINT we_version_compiled;
4623 UCHAR i, Padding = 0;
4624 BOOLEAN RadioState;
4625 UCHAR driverVersion[8];
4626 OID_SET_HT_PHYMODE *pHTPhyMode = NULL;
4627
4628
4629 #ifdef SNMP_SUPPORT
4630 //for snmp, kathy
4631 DefaultKeyIdxValue *pKeyIdxValue;
4632 INT valueLen;
4633 TX_RTY_CFG_STRUC tx_rty_cfg;
4634 ULONG ShortRetryLimit, LongRetryLimit;
4635 UCHAR tmp[64];
4636 #endif //SNMP
4637
4638 switch(cmd)
4639 {
4640 case RT_OID_DEVICE_NAME:
4641 wrq->u.data.length = sizeof(STA_NIC_DEVICE_NAME);
4642 Status = copy_to_user(wrq->u.data.pointer, STA_NIC_DEVICE_NAME, wrq->u.data.length);
4643 break;
4644 case RT_OID_VERSION_INFO:
4645 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_VERSION_INFO \n"));
4646 wrq->u.data.length = 8*sizeof(UCHAR);
4647 sprintf(&driverVersion[0], "%s", STA_DRIVER_VERSION);
4648 driverVersion[7] = '\0';
4649 if (copy_to_user(wrq->u.data.pointer, &driverVersion, wrq->u.data.length))
4650 {
4651 Status = -EFAULT;
4652 }
4653 break;
4654 #ifdef RALINK_ATE
4655 case RT_QUERY_ATE_TXDONE_COUNT:
4656 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_QUERY_ATE_TXDONE_COUNT \n"));
4657 wrq->u.data.length = sizeof(UINT32);
4658 if (copy_to_user(wrq->u.data.pointer, &pAdapter->ate.TxDoneCount, wrq->u.data.length))
4659 {
4660 Status = -EFAULT;
4661 }
4662 break;
4663 #endif // RALINK_ATE //
4664 case OID_802_11_BSSID_LIST:
4665 if (RTMP_TEST_FLAG(pAdapter, fRTMP_ADAPTER_BSS_SCAN_IN_PROGRESS))
4666 {
4667 /*
4668 * Still scanning, indicate the caller should try again.
4669 */
4670 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_BSSID_LIST (Still scanning)\n"));
4671 return -EAGAIN;
4672 }
4673 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_BSSID_LIST (%d BSS returned)\n",pAdapter->ScanTab.BssNr));
4674 pAdapter->StaCfg.bScanReqIsFromWebUI = FALSE;
4675 // Claculate total buffer size required
4676 BssBufSize = sizeof(ULONG);
4677
4678 for (i = 0; i < pAdapter->ScanTab.BssNr; i++)
4679 {
4680 // Align pointer to 4 bytes boundary.
4681 //Padding = 4 - (pAdapter->ScanTab.BssEntry[i].VarIELen & 0x0003);
4682 //if (Padding == 4)
4683 // Padding = 0;
4684 BssBufSize += (sizeof(NDIS_WLAN_BSSID_EX) - 1 + sizeof(NDIS_802_11_FIXED_IEs) + pAdapter->ScanTab.BssEntry[i].VarIELen + Padding);
4685 }
4686
4687 // For safety issue, we add 256 bytes just in case
4688 BssBufSize += 256;
4689 // Allocate the same size as passed from higher layer
4690 pBuf = kmalloc(BssBufSize, MEM_ALLOC_FLAG);
4691 if(pBuf == NULL)
4692 {
4693 Status = -ENOMEM;
4694 break;
4695 }
4696 // Init 802_11_BSSID_LIST_EX structure
4697 NdisZeroMemory(pBuf, BssBufSize);
4698 pBssidList = (PNDIS_802_11_BSSID_LIST_EX) pBuf;
4699 pBssidList->NumberOfItems = pAdapter->ScanTab.BssNr;
4700
4701 // Calculate total buffer length
4702 BssLen = 4; // Consist of NumberOfItems
4703 // Point to start of NDIS_WLAN_BSSID_EX
4704 // pPtr = pBuf + sizeof(ULONG);
4705 pPtr = (PUCHAR) &pBssidList->Bssid[0];
4706 for (i = 0; i < pAdapter->ScanTab.BssNr; i++)
4707 {
4708 pBss = (PNDIS_WLAN_BSSID_EX) pPtr;
4709 NdisMoveMemory(&pBss->MacAddress, &pAdapter->ScanTab.BssEntry[i].Bssid, MAC_ADDR_LEN);
4710 if ((pAdapter->ScanTab.BssEntry[i].Hidden == 1) && (pAdapter->StaCfg.bShowHiddenSSID == FALSE))
4711 {
4712 //
4713 // We must return this SSID during 4way handshaking, otherwise Aegis will failed to parse WPA infomation
4714 // and then failed to send EAPOl farame.
4715 //
4716 if ((pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA) && (pAdapter->StaCfg.PortSecured != WPA_802_1X_PORT_SECURED))
4717 {
4718 pBss->Ssid.SsidLength = pAdapter->ScanTab.BssEntry[i].SsidLen;
4719 NdisMoveMemory(pBss->Ssid.Ssid, pAdapter->ScanTab.BssEntry[i].Ssid, pAdapter->ScanTab.BssEntry[i].SsidLen);
4720 }
4721 else
4722 pBss->Ssid.SsidLength = 0;
4723 }
4724 else
4725 {
4726 pBss->Ssid.SsidLength = pAdapter->ScanTab.BssEntry[i].SsidLen;
4727 NdisMoveMemory(pBss->Ssid.Ssid, pAdapter->ScanTab.BssEntry[i].Ssid, pAdapter->ScanTab.BssEntry[i].SsidLen);
4728 }
4729 pBss->Privacy = pAdapter->ScanTab.BssEntry[i].Privacy;
4730 pBss->Rssi = pAdapter->ScanTab.BssEntry[i].Rssi - pAdapter->BbpRssiToDbmDelta;
4731 pBss->NetworkTypeInUse = NetworkTypeInUseSanity(&pAdapter->ScanTab.BssEntry[i]);
4732 pBss->Configuration.Length = sizeof(NDIS_802_11_CONFIGURATION);
4733 pBss->Configuration.BeaconPeriod = pAdapter->ScanTab.BssEntry[i].BeaconPeriod;
4734 pBss->Configuration.ATIMWindow = pAdapter->ScanTab.BssEntry[i].AtimWin;
4735
4736 MAP_CHANNEL_ID_TO_KHZ(pAdapter->ScanTab.BssEntry[i].Channel, pBss->Configuration.DSConfig);
4737
4738 if (pAdapter->ScanTab.BssEntry[i].BssType == BSS_INFRA)
4739 pBss->InfrastructureMode = Ndis802_11Infrastructure;
4740 else
4741 pBss->InfrastructureMode = Ndis802_11IBSS;
4742
4743 NdisMoveMemory(pBss->SupportedRates, pAdapter->ScanTab.BssEntry[i].SupRate, pAdapter->ScanTab.BssEntry[i].SupRateLen);
4744 NdisMoveMemory(pBss->SupportedRates + pAdapter->ScanTab.BssEntry[i].SupRateLen,
4745 pAdapter->ScanTab.BssEntry[i].ExtRate,
4746 pAdapter->ScanTab.BssEntry[i].ExtRateLen);
4747
4748 if (pAdapter->ScanTab.BssEntry[i].VarIELen == 0)
4749 {
4750 pBss->IELength = sizeof(NDIS_802_11_FIXED_IEs);
4751 NdisMoveMemory(pBss->IEs, &pAdapter->ScanTab.BssEntry[i].FixIEs, sizeof(NDIS_802_11_FIXED_IEs));
4752 pPtr = pPtr + sizeof(NDIS_WLAN_BSSID_EX) - 1 + sizeof(NDIS_802_11_FIXED_IEs);
4753 }
4754 else
4755 {
4756 pBss->IELength = (ULONG)(sizeof(NDIS_802_11_FIXED_IEs) + pAdapter->ScanTab.BssEntry[i].VarIELen);
4757 pPtr = pPtr + sizeof(NDIS_WLAN_BSSID_EX) - 1 + sizeof(NDIS_802_11_FIXED_IEs);
4758 NdisMoveMemory(pBss->IEs, &pAdapter->ScanTab.BssEntry[i].FixIEs, sizeof(NDIS_802_11_FIXED_IEs));
4759 NdisMoveMemory(pBss->IEs + sizeof(NDIS_802_11_FIXED_IEs), pAdapter->ScanTab.BssEntry[i].VarIEs, pAdapter->ScanTab.BssEntry[i].VarIELen);
4760 pPtr += pAdapter->ScanTab.BssEntry[i].VarIELen;
4761 }
4762 pBss->Length = (ULONG)(sizeof(NDIS_WLAN_BSSID_EX) - 1 + sizeof(NDIS_802_11_FIXED_IEs) + pAdapter->ScanTab.BssEntry[i].VarIELen + Padding);
4763
4764 #if WIRELESS_EXT < 17
4765 if ((BssLen + pBss->Length) < wrq->u.data.length)
4766 BssLen += pBss->Length;
4767 else
4768 {
4769 pBssidList->NumberOfItems = i;
4770 break;
4771 }
4772 #else
4773 BssLen += pBss->Length;
4774 #endif
4775 }
4776
4777 #if WIRELESS_EXT < 17
4778 wrq->u.data.length = BssLen;
4779 #else
4780 if (BssLen > wrq->u.data.length)
4781 {
4782 kfree(pBssidList);
4783 return -E2BIG;
4784 }
4785 else
4786 wrq->u.data.length = BssLen;
4787 #endif
4788 Status = copy_to_user(wrq->u.data.pointer, pBssidList, BssLen);
4789 kfree(pBssidList);
4790 break;
4791 case OID_802_3_CURRENT_ADDRESS:
4792 wrq->u.data.length = MAC_ADDR_LEN;
4793 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CurrentAddress, wrq->u.data.length);
4794 break;
4795 case OID_GEN_MEDIA_CONNECT_STATUS:
4796 if (pAdapter->IndicateMediaState == NdisMediaStateConnected)
4797 MediaState = NdisMediaStateConnected;
4798 else
4799 MediaState = NdisMediaStateDisconnected;
4800
4801 wrq->u.data.length = sizeof(NDIS_MEDIA_STATE);
4802 Status = copy_to_user(wrq->u.data.pointer, &MediaState, wrq->u.data.length);
4803 break;
4804 case OID_802_11_BSSID:
4805 #ifdef RALINK_ATE
4806 if (ATE_ON(pAdapter))
4807 {
4808 DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n"));
4809 Status = NDIS_STATUS_RESOURCES;
4810 break;
4811 }
4812 #endif // RALINK_ATE //
4813 if (INFRA_ON(pAdapter) || ADHOC_ON(pAdapter))
4814 {
4815 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.Bssid, sizeof(NDIS_802_11_MAC_ADDRESS));
4816
4817 }
4818 else
4819 {
4820 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_BSSID(=EMPTY)\n"));
4821 Status = -ENOTCONN;
4822 }
4823 break;
4824 case OID_802_11_SSID:
4825 NdisZeroMemory(&Ssid, sizeof(NDIS_802_11_SSID));
4826 NdisZeroMemory(Ssid.Ssid, MAX_LEN_OF_SSID);
4827 Ssid.SsidLength = pAdapter->CommonCfg.SsidLen;
4828 memcpy(Ssid.Ssid, pAdapter->CommonCfg.Ssid, Ssid.SsidLength);
4829 wrq->u.data.length = sizeof(NDIS_802_11_SSID);
4830 Status = copy_to_user(wrq->u.data.pointer, &Ssid, wrq->u.data.length);
4831 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_SSID (Len=%d, ssid=%s)\n", Ssid.SsidLength,Ssid.Ssid));
4832 break;
4833 case RT_OID_802_11_QUERY_LINK_STATUS:
4834 pLinkStatus = (RT_802_11_LINK_STATUS *) kmalloc(sizeof(RT_802_11_LINK_STATUS), MEM_ALLOC_FLAG);
4835 if (pLinkStatus)
4836 {
4837 pLinkStatus->CurrTxRate = RateIdTo500Kbps[pAdapter->CommonCfg.TxRate]; // unit : 500 kbps
4838 pLinkStatus->ChannelQuality = pAdapter->Mlme.ChannelQuality;
4839 pLinkStatus->RxByteCount = pAdapter->RalinkCounters.ReceivedByteCount;
4840 pLinkStatus->TxByteCount = pAdapter->RalinkCounters.TransmittedByteCount;
4841 pLinkStatus->CentralChannel = pAdapter->CommonCfg.CentralChannel;
4842 wrq->u.data.length = sizeof(RT_802_11_LINK_STATUS);
4843 Status = copy_to_user(wrq->u.data.pointer, pLinkStatus, wrq->u.data.length);
4844 kfree(pLinkStatus);
4845 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_LINK_STATUS\n"));
4846 }
4847 else
4848 {
4849 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_LINK_STATUS(kmalloc failed)\n"));
4850 Status = -EFAULT;
4851 }
4852 break;
4853 case OID_802_11_CONFIGURATION:
4854 pConfiguration = (NDIS_802_11_CONFIGURATION *) kmalloc(sizeof(NDIS_802_11_CONFIGURATION), MEM_ALLOC_FLAG);
4855 if (pConfiguration)
4856 {
4857 pConfiguration->Length = sizeof(NDIS_802_11_CONFIGURATION);
4858 pConfiguration->BeaconPeriod = pAdapter->CommonCfg.BeaconPeriod;
4859 pConfiguration->ATIMWindow = pAdapter->StaActive.AtimWin;
4860 MAP_CHANNEL_ID_TO_KHZ(pAdapter->CommonCfg.Channel, pConfiguration->DSConfig);
4861 wrq->u.data.length = sizeof(NDIS_802_11_CONFIGURATION);
4862 Status = copy_to_user(wrq->u.data.pointer, pConfiguration, wrq->u.data.length);
4863 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_CONFIGURATION(BeaconPeriod=%ld,AtimW=%ld,Channel=%d) \n",
4864 pConfiguration->BeaconPeriod, pConfiguration->ATIMWindow, pAdapter->CommonCfg.Channel));
4865 kfree(pConfiguration);
4866 }
4867 else
4868 {
4869 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_CONFIGURATION(kmalloc failed)\n"));
4870 Status = -EFAULT;
4871 }
4872 break;
4873 case RT_OID_802_11_SNR_0:
4874 if ((pAdapter->StaCfg.LastSNR0 > 0))
4875 {
4876 ulInfo = ((0xeb - pAdapter->StaCfg.LastSNR0) * 3) / 16 ;
4877 wrq->u.data.length = sizeof(ulInfo);
4878 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4879 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_SNR_0(0x=%lx)\n", ulInfo));
4880 }
4881 else
4882 Status = -EFAULT;
4883 break;
4884 case RT_OID_802_11_SNR_1:
4885 if ((pAdapter->Antenna.field.RxPath > 1) &&
4886 (pAdapter->StaCfg.LastSNR1 > 0))
4887 {
4888 ulInfo = ((0xeb - pAdapter->StaCfg.LastSNR1) * 3) / 16 ;
4889 wrq->u.data.length = sizeof(ulInfo);
4890 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4891 DBGPRINT(RT_DEBUG_TRACE,("Query::RT_OID_802_11_SNR_1(0x=%lx)\n",ulInfo));
4892 }
4893 else
4894 Status = -EFAULT;
4895 DBGPRINT(RT_DEBUG_TRACE,("Query::RT_OID_802_11_SNR_1(pAdapter->StaCfg.LastSNR1=%d)\n",pAdapter->StaCfg.LastSNR1));
4896 break;
4897 case OID_802_11_RSSI_TRIGGER:
4898 ulInfo = pAdapter->StaCfg.RssiSample.LastRssi0 - pAdapter->BbpRssiToDbmDelta;
4899 wrq->u.data.length = sizeof(ulInfo);
4900 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4901 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_RSSI_TRIGGER(=%ld)\n", ulInfo));
4902 break;
4903 case OID_802_11_RSSI:
4904 case RT_OID_802_11_RSSI:
4905 ulInfo = pAdapter->StaCfg.RssiSample.LastRssi0;
4906 wrq->u.data.length = sizeof(ulInfo);
4907 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4908 break;
4909 case RT_OID_802_11_RSSI_1:
4910 ulInfo = pAdapter->StaCfg.RssiSample.LastRssi1;
4911 wrq->u.data.length = sizeof(ulInfo);
4912 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4913 break;
4914 case RT_OID_802_11_RSSI_2:
4915 ulInfo = pAdapter->StaCfg.RssiSample.LastRssi2;
4916 wrq->u.data.length = sizeof(ulInfo);
4917 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4918 break;
4919 case OID_802_11_STATISTICS:
4920 pStatistics = (NDIS_802_11_STATISTICS *) kmalloc(sizeof(NDIS_802_11_STATISTICS), MEM_ALLOC_FLAG);
4921 if (pStatistics)
4922 {
4923 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_STATISTICS \n"));
4924 // add the most up-to-date h/w raw counters into software counters
4925 NICUpdateRawCounters(pAdapter);
4926
4927 // Sanity check for calculation of sucessful count
4928 if (pAdapter->WlanCounters.TransmittedFragmentCount.QuadPart < pAdapter->WlanCounters.RetryCount.QuadPart)
4929 pAdapter->WlanCounters.TransmittedFragmentCount.QuadPart = pAdapter->WlanCounters.RetryCount.QuadPart;
4930
4931 pStatistics->TransmittedFragmentCount.QuadPart = pAdapter->WlanCounters.TransmittedFragmentCount.QuadPart;
4932 pStatistics->MulticastTransmittedFrameCount.QuadPart = pAdapter->WlanCounters.MulticastTransmittedFrameCount.QuadPart;
4933 pStatistics->FailedCount.QuadPart = pAdapter->WlanCounters.FailedCount.QuadPart;
4934 pStatistics->RetryCount.QuadPart = pAdapter->WlanCounters.RetryCount.QuadPart;
4935 pStatistics->MultipleRetryCount.QuadPart = pAdapter->WlanCounters.MultipleRetryCount.QuadPart;
4936 pStatistics->RTSSuccessCount.QuadPart = pAdapter->WlanCounters.RTSSuccessCount.QuadPart;
4937 pStatistics->RTSFailureCount.QuadPart = pAdapter->WlanCounters.RTSFailureCount.QuadPart;
4938 pStatistics->ACKFailureCount.QuadPart = pAdapter->WlanCounters.ACKFailureCount.QuadPart;
4939 pStatistics->FrameDuplicateCount.QuadPart = pAdapter->WlanCounters.FrameDuplicateCount.QuadPart;
4940 pStatistics->ReceivedFragmentCount.QuadPart = pAdapter->WlanCounters.ReceivedFragmentCount.QuadPart;
4941 pStatistics->MulticastReceivedFrameCount.QuadPart = pAdapter->WlanCounters.MulticastReceivedFrameCount.QuadPart;
4942 #ifdef DBG
4943 pStatistics->FCSErrorCount = pAdapter->RalinkCounters.RealFcsErrCount;
4944 #else
4945 pStatistics->FCSErrorCount.QuadPart = pAdapter->WlanCounters.FCSErrorCount.QuadPart;
4946 pStatistics->FrameDuplicateCount.u.LowPart = pAdapter->WlanCounters.FrameDuplicateCount.u.LowPart / 100;
4947 #endif
4948 wrq->u.data.length = sizeof(NDIS_802_11_STATISTICS);
4949 Status = copy_to_user(wrq->u.data.pointer, pStatistics, wrq->u.data.length);
4950 kfree(pStatistics);
4951 }
4952 else
4953 {
4954 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_STATISTICS(kmalloc failed)\n"));
4955 Status = -EFAULT;
4956 }
4957 break;
4958 case OID_GEN_RCV_OK:
4959 ulInfo = pAdapter->Counters8023.GoodReceives;
4960 wrq->u.data.length = sizeof(ulInfo);
4961 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4962 break;
4963 case OID_GEN_RCV_NO_BUFFER:
4964 ulInfo = pAdapter->Counters8023.RxNoBuffer;
4965 wrq->u.data.length = sizeof(ulInfo);
4966 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4967 break;
4968 case RT_OID_802_11_PHY_MODE:
4969 ulInfo = (ULONG)pAdapter->CommonCfg.PhyMode;
4970 wrq->u.data.length = sizeof(ulInfo);
4971 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
4972 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_PHY_MODE (=%ld)\n", ulInfo));
4973 break;
4974 case RT_OID_802_11_STA_CONFIG:
4975 pStaConfig = (RT_802_11_STA_CONFIG *) kmalloc(sizeof(RT_802_11_STA_CONFIG), MEM_ALLOC_FLAG);
4976 if (pStaConfig)
4977 {
4978 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_STA_CONFIG\n"));
4979 pStaConfig->EnableTxBurst = pAdapter->CommonCfg.bEnableTxBurst;
4980 pStaConfig->EnableTurboRate = 0;
4981 pStaConfig->UseBGProtection = pAdapter->CommonCfg.UseBGProtection;
4982 pStaConfig->UseShortSlotTime = pAdapter->CommonCfg.bUseShortSlotTime;
4983 //pStaConfig->AdhocMode = pAdapter->StaCfg.AdhocMode;
4984 pStaConfig->HwRadioStatus = (pAdapter->StaCfg.bHwRadio == TRUE) ? 1 : 0;
4985 pStaConfig->Rsv1 = 0;
4986 pStaConfig->SystemErrorBitmap = pAdapter->SystemErrorBitmap;
4987 wrq->u.data.length = sizeof(RT_802_11_STA_CONFIG);
4988 Status = copy_to_user(wrq->u.data.pointer, pStaConfig, wrq->u.data.length);
4989 kfree(pStaConfig);
4990 }
4991 else
4992 {
4993 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_STA_CONFIG(kmalloc failed)\n"));
4994 Status = -EFAULT;
4995 }
4996 break;
4997 case OID_802_11_RTS_THRESHOLD:
4998 RtsThresh = pAdapter->CommonCfg.RtsThreshold;
4999 wrq->u.data.length = sizeof(RtsThresh);
5000 Status = copy_to_user(wrq->u.data.pointer, &RtsThresh, wrq->u.data.length);
5001 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_RTS_THRESHOLD(=%ld)\n", RtsThresh));
5002 break;
5003 case OID_802_11_FRAGMENTATION_THRESHOLD:
5004 FragThresh = pAdapter->CommonCfg.FragmentThreshold;
5005 if (pAdapter->CommonCfg.bUseZeroToDisableFragment == TRUE)
5006 FragThresh = 0;
5007 wrq->u.data.length = sizeof(FragThresh);
5008 Status = copy_to_user(wrq->u.data.pointer, &FragThresh, wrq->u.data.length);
5009 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_FRAGMENTATION_THRESHOLD(=%ld)\n", FragThresh));
5010 break;
5011 case OID_802_11_POWER_MODE:
5012 PowerMode = pAdapter->StaCfg.WindowsPowerMode;
5013 wrq->u.data.length = sizeof(PowerMode);
5014 Status = copy_to_user(wrq->u.data.pointer, &PowerMode, wrq->u.data.length);
5015 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_POWER_MODE(=%d)\n", PowerMode));
5016 break;
5017 case RT_OID_802_11_RADIO:
5018 RadioState = (BOOLEAN) pAdapter->StaCfg.bSwRadio;
5019 wrq->u.data.length = sizeof(RadioState);
5020 Status = copy_to_user(wrq->u.data.pointer, &RadioState, wrq->u.data.length);
5021 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_RADIO (=%d)\n", RadioState));
5022 break;
5023 case OID_802_11_INFRASTRUCTURE_MODE:
5024 if (pAdapter->StaCfg.BssType == BSS_ADHOC)
5025 BssType = Ndis802_11IBSS;
5026 else if (pAdapter->StaCfg.BssType == BSS_INFRA)
5027 BssType = Ndis802_11Infrastructure;
5028 else if (pAdapter->StaCfg.BssType == BSS_MONITOR)
5029 BssType = Ndis802_11Monitor;
5030 else
5031 BssType = Ndis802_11AutoUnknown;
5032
5033 wrq->u.data.length = sizeof(BssType);
5034 Status = copy_to_user(wrq->u.data.pointer, &BssType, wrq->u.data.length);
5035 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_INFRASTRUCTURE_MODE(=%d)\n", BssType));
5036 break;
5037 case RT_OID_802_11_PREAMBLE:
5038 PreamType = pAdapter->CommonCfg.TxPreamble;
5039 wrq->u.data.length = sizeof(PreamType);
5040 Status = copy_to_user(wrq->u.data.pointer, &PreamType, wrq->u.data.length);
5041 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_PREAMBLE(=%d)\n", PreamType));
5042 break;
5043 case OID_802_11_AUTHENTICATION_MODE:
5044 AuthMode = pAdapter->StaCfg.AuthMode;
5045 wrq->u.data.length = sizeof(AuthMode);
5046 Status = copy_to_user(wrq->u.data.pointer, &AuthMode, wrq->u.data.length);
5047 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_AUTHENTICATION_MODE(=%d)\n", AuthMode));
5048 break;
5049 case OID_802_11_WEP_STATUS:
5050 WepStatus = pAdapter->StaCfg.WepStatus;
5051 wrq->u.data.length = sizeof(WepStatus);
5052 Status = copy_to_user(wrq->u.data.pointer, &WepStatus, wrq->u.data.length);
5053 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_WEP_STATUS(=%d)\n", WepStatus));
5054 break;
5055 case OID_802_11_TX_POWER_LEVEL:
5056 wrq->u.data.length = sizeof(ULONG);
5057 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.TxPower, wrq->u.data.length);
5058 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_TX_POWER_LEVEL %x\n",pAdapter->CommonCfg.TxPower));
5059 break;
5060 case RT_OID_802_11_TX_POWER_LEVEL_1:
5061 wrq->u.data.length = sizeof(ULONG);
5062 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.TxPowerPercentage, wrq->u.data.length);
5063 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_TX_POWER_LEVEL_1 (=%ld)\n", pAdapter->CommonCfg.TxPowerPercentage));
5064 break;
5065 case OID_802_11_NETWORK_TYPES_SUPPORTED:
5066 if ((pAdapter->RfIcType == RFIC_2850) || (pAdapter->RfIcType == RFIC_2750))
5067 {
5068 NetworkTypeList[0] = 3; // NumberOfItems = 3
5069 NetworkTypeList[1] = Ndis802_11DS; // NetworkType[1] = 11b
5070 NetworkTypeList[2] = Ndis802_11OFDM24; // NetworkType[2] = 11g
5071 NetworkTypeList[3] = Ndis802_11OFDM5; // NetworkType[3] = 11a
5072 wrq->u.data.length = 16;
5073 Status = copy_to_user(wrq->u.data.pointer, &NetworkTypeList[0], wrq->u.data.length);
5074 }
5075 else
5076 {
5077 NetworkTypeList[0] = 2; // NumberOfItems = 2
5078 NetworkTypeList[1] = Ndis802_11DS; // NetworkType[1] = 11b
5079 NetworkTypeList[2] = Ndis802_11OFDM24; // NetworkType[2] = 11g
5080 wrq->u.data.length = 12;
5081 Status = copy_to_user(wrq->u.data.pointer, &NetworkTypeList[0], wrq->u.data.length);
5082 }
5083 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_NETWORK_TYPES_SUPPORTED\n"));
5084 break;
5085 case OID_802_11_NETWORK_TYPE_IN_USE:
5086 wrq->u.data.length = sizeof(ULONG);
5087 if (pAdapter->CommonCfg.PhyMode == PHY_11A)
5088 ulInfo = Ndis802_11OFDM5;
5089 else if ((pAdapter->CommonCfg.PhyMode == PHY_11BG_MIXED) || (pAdapter->CommonCfg.PhyMode == PHY_11G))
5090 ulInfo = Ndis802_11OFDM24;
5091 else
5092 ulInfo = Ndis802_11DS;
5093 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
5094 break;
5095 case RT_OID_802_11_QUERY_LAST_RX_RATE:
5096 ulInfo = (ULONG)pAdapter->LastRxRate;
5097 wrq->u.data.length = sizeof(ulInfo);
5098 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
5099 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_LAST_RX_RATE (=%ld)\n", ulInfo));
5100 break;
5101 case RT_OID_802_11_QUERY_LAST_TX_RATE:
5102 //ulInfo = (ULONG)pAdapter->LastTxRate;
5103 ulInfo = (ULONG)pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.word;
5104 wrq->u.data.length = sizeof(ulInfo);
5105 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
5106 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_LAST_TX_RATE (=%lx)\n", ulInfo));
5107 break;
5108 case RT_OID_802_11_QUERY_EEPROM_VERSION:
5109 wrq->u.data.length = sizeof(ULONG);
5110 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->EepromVersion, wrq->u.data.length);
5111 break;
5112 case RT_OID_802_11_QUERY_FIRMWARE_VERSION:
5113 wrq->u.data.length = sizeof(ULONG);
5114 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->FirmwareVersion, wrq->u.data.length);
5115 break;
5116 case RT_OID_802_11_QUERY_NOISE_LEVEL:
5117 wrq->u.data.length = sizeof(UCHAR);
5118 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->BbpWriteLatch[66], wrq->u.data.length);
5119 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_NOISE_LEVEL (=%d)\n", pAdapter->BbpWriteLatch[66]));
5120 break;
5121 case RT_OID_802_11_EXTRA_INFO:
5122 wrq->u.data.length = sizeof(ULONG);
5123 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->ExtraInfo, wrq->u.data.length);
5124 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_EXTRA_INFO (=%ld)\n", pAdapter->ExtraInfo));
5125 break;
5126 case RT_OID_WE_VERSION_COMPILED:
5127 wrq->u.data.length = sizeof(UINT);
5128 we_version_compiled = WIRELESS_EXT;
5129 Status = copy_to_user(wrq->u.data.pointer, &we_version_compiled, wrq->u.data.length);
5130 break;
5131 case RT_OID_802_11_QUERY_APSD_SETTING:
5132 apsd = (pAdapter->CommonCfg.bAPSDCapable | (pAdapter->CommonCfg.bAPSDAC_BE << 1) | (pAdapter->CommonCfg.bAPSDAC_BK << 2)
5133 | (pAdapter->CommonCfg.bAPSDAC_VI << 3) | (pAdapter->CommonCfg.bAPSDAC_VO << 4) | (pAdapter->CommonCfg.MaxSPLength << 5));
5134
5135 wrq->u.data.length = sizeof(ULONG);
5136 Status = copy_to_user(wrq->u.data.pointer, &apsd, wrq->u.data.length);
5137 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_APSD_SETTING (=0x%lx,APSDCap=%d,AC_BE=%d,AC_BK=%d,AC_VI=%d,AC_VO=%d,MAXSPLen=%d)\n",
5138 apsd,pAdapter->CommonCfg.bAPSDCapable,pAdapter->CommonCfg.bAPSDAC_BE,pAdapter->CommonCfg.bAPSDAC_BK,pAdapter->CommonCfg.bAPSDAC_VI,pAdapter->CommonCfg.bAPSDAC_VO,pAdapter->CommonCfg.MaxSPLength));
5139 break;
5140 case RT_OID_802_11_QUERY_APSD_PSM:
5141 wrq->u.data.length = sizeof(ULONG);
5142 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.bAPSDForcePowerSave, wrq->u.data.length);
5143 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_APSD_PSM (=%d)\n", pAdapter->CommonCfg.bAPSDForcePowerSave));
5144 break;
5145 case RT_OID_802_11_QUERY_WMM:
5146 wrq->u.data.length = sizeof(BOOLEAN);
5147 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.bWmmCapable, wrq->u.data.length);
5148 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_WMM (=%d)\n", pAdapter->CommonCfg.bWmmCapable));
5149 break;
5150 #ifdef WPA_SUPPLICANT_SUPPORT
5151 case RT_OID_NEW_DRIVER:
5152 {
5153 UCHAR enabled = 1;
5154 wrq->u.data.length = sizeof(UCHAR);
5155 Status = copy_to_user(wrq->u.data.pointer, &enabled, wrq->u.data.length);
5156 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_NEW_DRIVER (=%d)\n", enabled));
5157 }
5158 break;
5159 case RT_OID_WPA_SUPPLICANT_SUPPORT:
5160 wrq->u.data.length = sizeof(UCHAR);
5161 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->StaCfg.WpaSupplicantUP, wrq->u.data.length);
5162 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_WPA_SUPPLICANT_SUPPORT (=%d)\n", pAdapter->StaCfg.WpaSupplicantUP));
5163 break;
5164 #endif // WPA_SUPPLICANT_SUPPORT //
5165
5166 case RT_OID_DRIVER_DEVICE_NAME:
5167 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_DRIVER_DEVICE_NAME \n"));
5168 wrq->u.data.length = 16;
5169 if (copy_to_user(wrq->u.data.pointer, pAdapter->StaCfg.dev_name, wrq->u.data.length))
5170 {
5171 Status = -EFAULT;
5172 }
5173 break;
5174 case RT_OID_802_11_QUERY_HT_PHYMODE:
5175 pHTPhyMode = (OID_SET_HT_PHYMODE *) kmalloc(sizeof(OID_SET_HT_PHYMODE), MEM_ALLOC_FLAG);
5176 if (pHTPhyMode)
5177 {
5178 pHTPhyMode->PhyMode = pAdapter->CommonCfg.PhyMode;
5179 pHTPhyMode->HtMode = (UCHAR)pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.field.MODE;
5180 pHTPhyMode->BW = (UCHAR)pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.field.BW;
5181 pHTPhyMode->MCS= (UCHAR)pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.field.MCS;
5182 pHTPhyMode->SHORTGI= (UCHAR)pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.field.ShortGI;
5183 pHTPhyMode->STBC= (UCHAR)pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.field.STBC;
5184
5185 pHTPhyMode->ExtOffset = ((pAdapter->CommonCfg.CentralChannel < pAdapter->CommonCfg.Channel) ? (EXTCHA_BELOW) : (EXTCHA_ABOVE));
5186 wrq->u.data.length = sizeof(OID_SET_HT_PHYMODE);
5187 if (copy_to_user(wrq->u.data.pointer, pHTPhyMode, wrq->u.data.length))
5188 {
5189 Status = -EFAULT;
5190 }
5191 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_HT_PHYMODE (PhyMode = %d, MCS =%d, BW = %d, STBC = %d, ExtOffset=%d)\n",
5192 pHTPhyMode->HtMode, pHTPhyMode->MCS, pHTPhyMode->BW, pHTPhyMode->STBC, pHTPhyMode->ExtOffset));
5193 DBGPRINT(RT_DEBUG_TRACE, (" MlmeUpdateTxRates (.word = %x )\n", pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.word));
5194 }
5195 else
5196 {
5197 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_STA_CONFIG(kmalloc failed)\n"));
5198 Status = -EFAULT;
5199 }
5200 break;
5201 case RT_OID_802_11_COUNTRY_REGION:
5202 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_COUNTRY_REGION \n"));
5203 wrq->u.data.length = sizeof(ulInfo);
5204 ulInfo = pAdapter->CommonCfg.CountryRegionForABand;
5205 ulInfo = (ulInfo << 8)|(pAdapter->CommonCfg.CountryRegion);
5206 if (copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length))
5207 {
5208 Status = -EFAULT;
5209 }
5210 break;
5211 case RT_OID_802_11_QUERY_DAT_HT_PHYMODE:
5212 pHTPhyMode = (OID_SET_HT_PHYMODE *) kmalloc(sizeof(OID_SET_HT_PHYMODE), MEM_ALLOC_FLAG);
5213 if (pHTPhyMode)
5214 {
5215 pHTPhyMode->PhyMode = pAdapter->CommonCfg.PhyMode;
5216 pHTPhyMode->HtMode = (UCHAR)pAdapter->CommonCfg.RegTransmitSetting.field.HTMODE;
5217 pHTPhyMode->BW = (UCHAR)pAdapter->CommonCfg.RegTransmitSetting.field.BW;
5218 pHTPhyMode->MCS= (UCHAR)pAdapter->StaCfg.DesiredTransmitSetting.field.MCS;
5219 pHTPhyMode->SHORTGI= (UCHAR)pAdapter->CommonCfg.RegTransmitSetting.field.ShortGI;
5220 pHTPhyMode->STBC= (UCHAR)pAdapter->CommonCfg.RegTransmitSetting.field.STBC;
5221
5222 wrq->u.data.length = sizeof(OID_SET_HT_PHYMODE);
5223 if (copy_to_user(wrq->u.data.pointer, pHTPhyMode, wrq->u.data.length))
5224 {
5225 Status = -EFAULT;
5226 }
5227 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_HT_PHYMODE (PhyMode = %d, MCS =%d, BW = %d, STBC = %d, ExtOffset=%d)\n",
5228 pHTPhyMode->HtMode, pHTPhyMode->MCS, pHTPhyMode->BW, pHTPhyMode->STBC, pHTPhyMode->ExtOffset));
5229 DBGPRINT(RT_DEBUG_TRACE, (" MlmeUpdateTxRates (.word = %x )\n", pAdapter->MacTab.Content[BSSID_WCID].HTPhyMode.word));
5230 }
5231 else
5232 {
5233 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_STA_CONFIG(kmalloc failed)\n"));
5234 Status = -EFAULT;
5235 }
5236 break;
5237 case RT_OID_QUERY_MULTIPLE_CARD_SUPPORT:
5238 wrq->u.data.length = sizeof(UCHAR);
5239 i = 0;
5240 #ifdef MULTIPLE_CARD_SUPPORT
5241 i = 1;
5242 #endif // MULTIPLE_CARD_SUPPORT //
5243 if (copy_to_user(wrq->u.data.pointer, &i, wrq->u.data.length))
5244 {
5245 Status = -EFAULT;
5246 }
5247 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_QUERY_MULTIPLE_CARD_SUPPORT(=%d) \n", i));
5248 break;
5249 #ifdef SNMP_SUPPORT
5250 case RT_OID_802_11_MAC_ADDRESS:
5251 wrq->u.data.length = MAC_ADDR_LEN;
5252 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CurrentAddress, wrq->u.data.length);
5253 break;
5254
5255 case RT_OID_802_11_MANUFACTUREROUI:
5256 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_MANUFACTUREROUI \n"));
5257 wrq->u.data.length = ManufacturerOUI_LEN;
5258 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CurrentAddress, wrq->u.data.length);
5259 break;
5260
5261 case RT_OID_802_11_MANUFACTURERNAME:
5262 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_MANUFACTURERNAME \n"));
5263 wrq->u.data.length = strlen(ManufacturerNAME);
5264 Status = copy_to_user(wrq->u.data.pointer, ManufacturerNAME, wrq->u.data.length);
5265 break;
5266
5267 case RT_OID_802_11_RESOURCETYPEIDNAME:
5268 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_RESOURCETYPEIDNAME \n"));
5269 wrq->u.data.length = strlen(ResourceTypeIdName);
5270 Status = copy_to_user(wrq->u.data.pointer, ResourceTypeIdName, wrq->u.data.length);
5271 break;
5272
5273 case RT_OID_802_11_PRIVACYOPTIONIMPLEMENTED:
5274 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_PRIVACYOPTIONIMPLEMENTED \n"));
5275 ulInfo = 1; // 1 is support wep else 2 is not support.
5276 wrq->u.data.length = sizeof(ulInfo);
5277 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
5278 break;
5279
5280 case RT_OID_802_11_POWERMANAGEMENTMODE:
5281 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_POWERMANAGEMENTMODE \n"));
5282 if (pAdapter->StaCfg.Psm == PSMP_ACTION)
5283 ulInfo = 1; // 1 is power active else 2 is power save.
5284 else
5285 ulInfo = 2;
5286
5287 wrq->u.data.length = sizeof(ulInfo);
5288 Status = copy_to_user(wrq->u.data.pointer, &ulInfo, wrq->u.data.length);
5289 break;
5290
5291 case OID_802_11_WEPDEFAULTKEYVALUE:
5292 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_WEPDEFAULTKEYVALUE \n"));
5293 //KeyIdxValue.KeyIdx = pAd->PortCfg.MBSSID[pAd->IoctlIF].DefaultKeyId;
5294 pKeyIdxValue = wrq->u.data.pointer;
5295 DBGPRINT(RT_DEBUG_TRACE,("KeyIdxValue.KeyIdx = %d, \n",pKeyIdxValue->KeyIdx));
5296 valueLen = pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].KeyLen;
5297 NdisMoveMemory(pKeyIdxValue->Value,
5298 &pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].Key,
5299 valueLen);
5300 pKeyIdxValue->Value[valueLen]='\0';
5301
5302 wrq->u.data.length = sizeof(DefaultKeyIdxValue);
5303
5304 Status = copy_to_user(wrq->u.data.pointer, pKeyIdxValue, wrq->u.data.length);
5305 DBGPRINT(RT_DEBUG_TRACE,("DefaultKeyId = %d, total len = %d, str len=%d, KeyValue= %02x %02x %02x %02x \n", pAdapter->StaCfg.DefaultKeyId, wrq->u.data.length, pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].KeyLen,
5306 pAdapter->SharedKey[BSS0][0].Key[0],
5307 pAdapter->SharedKey[BSS0][1].Key[0],
5308 pAdapter->SharedKey[BSS0][2].Key[0],
5309 pAdapter->SharedKey[BSS0][3].Key[0]));
5310 break;
5311
5312 case OID_802_11_WEPDEFAULTKEYID:
5313 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_WEPDEFAULTKEYID \n"));
5314 wrq->u.data.length = sizeof(UCHAR);
5315 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->StaCfg.DefaultKeyId, wrq->u.data.length);
5316 DBGPRINT(RT_DEBUG_TRACE, ("DefaultKeyId =%d \n", pAdapter->StaCfg.DefaultKeyId));
5317 break;
5318
5319 case RT_OID_802_11_WEPKEYMAPPINGLENGTH:
5320 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_WEPKEYMAPPINGLENGTH \n"));
5321 wrq->u.data.length = sizeof(UCHAR);
5322 Status = copy_to_user(wrq->u.data.pointer,
5323 &pAdapter->SharedKey[BSS0][pAdapter->StaCfg.DefaultKeyId].KeyLen,
5324 wrq->u.data.length);
5325 break;
5326
5327 case OID_802_11_SHORTRETRYLIMIT:
5328 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_SHORTRETRYLIMIT \n"));
5329 wrq->u.data.length = sizeof(ULONG);
5330 RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
5331 ShortRetryLimit = tx_rty_cfg.field.ShortRtyLimit;
5332 DBGPRINT(RT_DEBUG_TRACE, ("ShortRetryLimit =%ld, tx_rty_cfg.field.ShortRetryLimit=%d\n", ShortRetryLimit, tx_rty_cfg.field.ShortRtyLimit));
5333 Status = copy_to_user(wrq->u.data.pointer, &ShortRetryLimit, wrq->u.data.length);
5334 break;
5335
5336 case OID_802_11_LONGRETRYLIMIT:
5337 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_LONGRETRYLIMIT \n"));
5338 wrq->u.data.length = sizeof(ULONG);
5339 RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
5340 LongRetryLimit = tx_rty_cfg.field.LongRtyLimit;
5341 DBGPRINT(RT_DEBUG_TRACE, ("LongRetryLimit =%ld, tx_rty_cfg.field.LongRtyLimit=%d\n", LongRetryLimit, tx_rty_cfg.field.LongRtyLimit));
5342 Status = copy_to_user(wrq->u.data.pointer, &LongRetryLimit, wrq->u.data.length);
5343 break;
5344
5345 case RT_OID_802_11_PRODUCTID:
5346 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_PRODUCTID \n"));
5347
5348 #ifdef RT2870
5349 sprintf(tmp, "%04x %04x\n", ((POS_COOKIE)pAdapter->OS_Cookie)->pUsb_Dev->descriptor.idVendor ,((POS_COOKIE)pAdapter->OS_Cookie)->pUsb_Dev->descriptor.idProduct);
5350
5351 #endif // RT2870 //
5352 wrq->u.data.length = strlen(tmp);
5353 Status = copy_to_user(wrq->u.data.pointer, tmp, wrq->u.data.length);
5354 break;
5355
5356 case RT_OID_802_11_MANUFACTUREID:
5357 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_MANUFACTUREID \n"));
5358 wrq->u.data.length = strlen(ManufacturerNAME);
5359 Status = copy_to_user(wrq->u.data.pointer, ManufacturerNAME, wrq->u.data.length);
5360 break;
5361
5362 case OID_802_11_CURRENTCHANNEL:
5363 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_CURRENTCHANNEL \n"));
5364 wrq->u.data.length = sizeof(UCHAR);
5365 DBGPRINT(RT_DEBUG_TRACE, ("sizeof UCHAR=%d, channel=%d \n", sizeof(UCHAR), pAdapter->CommonCfg.Channel));
5366 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.Channel, wrq->u.data.length);
5367 DBGPRINT(RT_DEBUG_TRACE, ("Status=%d\n", Status));
5368 break;
5369 #endif //SNMP_SUPPORT
5370
5371 case OID_802_11_BUILD_CHANNEL_EX:
5372 {
5373 UCHAR value;
5374 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_BUILD_CHANNEL_EX \n"));
5375 wrq->u.data.length = sizeof(UCHAR);
5376 #ifdef EXT_BUILD_CHANNEL_LIST
5377 DBGPRINT(RT_DEBUG_TRACE, ("Support EXT_BUILD_CHANNEL_LIST.\n"));
5378 value = 1;
5379 #else
5380 DBGPRINT(RT_DEBUG_TRACE, ("Doesn't support EXT_BUILD_CHANNEL_LIST.\n"));
5381 value = 0;
5382 #endif // EXT_BUILD_CHANNEL_LIST //
5383 Status = copy_to_user(wrq->u.data.pointer, &value, 1);
5384 DBGPRINT(RT_DEBUG_TRACE, ("Status=%d\n", Status));
5385 }
5386 break;
5387
5388 case OID_802_11_GET_CH_LIST:
5389 {
5390 PRT_CHANNEL_LIST_INFO pChListBuf;
5391
5392 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_GET_CH_LIST \n"));
5393 if (pAdapter->ChannelListNum == 0)
5394 {
5395 wrq->u.data.length = 0;
5396 break;
5397 }
5398
5399 pChListBuf = (RT_CHANNEL_LIST_INFO *) kmalloc(sizeof(RT_CHANNEL_LIST_INFO), MEM_ALLOC_FLAG);
5400 if (pChListBuf == NULL)
5401 {
5402 wrq->u.data.length = 0;
5403 break;
5404 }
5405
5406 pChListBuf->ChannelListNum = pAdapter->ChannelListNum;
5407 for (i = 0; i < pChListBuf->ChannelListNum; i++)
5408 pChListBuf->ChannelList[i] = pAdapter->ChannelList[i].Channel;
5409
5410 wrq->u.data.length = sizeof(RT_CHANNEL_LIST_INFO);
5411 Status = copy_to_user(wrq->u.data.pointer, pChListBuf, sizeof(RT_CHANNEL_LIST_INFO));
5412 DBGPRINT(RT_DEBUG_TRACE, ("Status=%d\n", Status));
5413
5414 if (pChListBuf)
5415 kfree(pChListBuf);
5416 }
5417 break;
5418
5419 case OID_802_11_GET_COUNTRY_CODE:
5420 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_GET_COUNTRY_CODE \n"));
5421 wrq->u.data.length = 2;
5422 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.CountryCode, 2);
5423 DBGPRINT(RT_DEBUG_TRACE, ("Status=%d\n", Status));
5424 break;
5425
5426 case OID_802_11_GET_CHANNEL_GEOGRAPHY:
5427 DBGPRINT(RT_DEBUG_TRACE, ("Query::OID_802_11_GET_CHANNEL_GEOGRAPHY \n"));
5428 wrq->u.data.length = 1;
5429 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.Geography, 1);
5430 DBGPRINT(RT_DEBUG_TRACE, ("Status=%d\n", Status));
5431 break;
5432
5433
5434 #ifdef QOS_DLS_SUPPORT
5435 case RT_OID_802_11_QUERY_DLS:
5436 wrq->u.data.length = sizeof(BOOLEAN);
5437 Status = copy_to_user(wrq->u.data.pointer, &pAdapter->CommonCfg.bDLSCapable, wrq->u.data.length);
5438 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_DLS(=%d)\n", pAdapter->CommonCfg.bDLSCapable));
5439 break;
5440
5441 case RT_OID_802_11_QUERY_DLS_PARAM:
5442 {
5443 PRT_802_11_DLS_INFO pDlsInfo = kmalloc(sizeof(RT_802_11_DLS_INFO), GFP_ATOMIC);
5444 if (pDlsInfo == NULL)
5445 break;
5446
5447 for (i=0; i<MAX_NUM_OF_DLS_ENTRY; i++)
5448 {
5449 RTMPMoveMemory(&pDlsInfo->Entry[i], &pAdapter->StaCfg.DLSEntry[i], sizeof(RT_802_11_DLS_UI));
5450 }
5451
5452 pDlsInfo->num = MAX_NUM_OF_DLS_ENTRY;
5453 wrq->u.data.length = sizeof(RT_802_11_DLS_INFO);
5454 Status = copy_to_user(wrq->u.data.pointer, pDlsInfo, wrq->u.data.length);
5455 DBGPRINT(RT_DEBUG_TRACE, ("Query::RT_OID_802_11_QUERY_DLS_PARAM\n"));
5456
5457 if (pDlsInfo)
5458 kfree(pDlsInfo);
5459 }
5460 break;
5461 #endif // QOS_DLS_SUPPORT //
5462 default:
5463 DBGPRINT(RT_DEBUG_TRACE, ("Query::unknown IOCTL's subcmd = 0x%08x\n", cmd));
5464 Status = -EOPNOTSUPP;
5465 break;
5466 }
5467 return Status;
5468 }
5469
5470 INT rt28xx_sta_ioctl(
5471 IN struct net_device *net_dev,
5472 IN OUT struct ifreq *rq,
5473 IN INT cmd)
5474 {
5475 POS_COOKIE pObj;
5476 VIRTUAL_ADAPTER *pVirtualAd = NULL;
5477 RTMP_ADAPTER *pAd = NULL;
5478 struct iwreq *wrq = (struct iwreq *) rq;
5479 BOOLEAN StateMachineTouched = FALSE;
5480 INT Status = NDIS_STATUS_SUCCESS;
5481 USHORT subcmd;
5482
5483 if (net_dev->priv_flags == INT_MAIN)
5484 {
5485 pAd = net_dev->ml_priv;
5486 }
5487 else
5488 {
5489 pVirtualAd = net_dev->ml_priv;
5490 pAd = pVirtualAd->RtmpDev->ml_priv;
5491 }
5492 pObj = (POS_COOKIE) pAd->OS_Cookie;
5493
5494 if (pAd == NULL)
5495 {
5496 /* if 1st open fail, pAd will be free;
5497 So the net_dev->ml_priv will be NULL in 2rd open */
5498 return -ENETDOWN;
5499 }
5500
5501 //check if the interface is down
5502 if(!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_INTERRUPT_IN_USE))
5503 {
5504 #ifdef CONFIG_APSTA_MIXED_SUPPORT
5505 if (wrq->u.data.pointer == NULL)
5506 {
5507 return Status;
5508 }
5509
5510 if (strstr(wrq->u.data.pointer, "OpMode") == NULL)
5511 #endif // CONFIG_APSTA_MIXED_SUPPORT //
5512 {
5513 DBGPRINT(RT_DEBUG_TRACE, ("INFO::Network is down!\n"));
5514 return -ENETDOWN;
5515 }
5516 }
5517
5518 { // determine this ioctl command is comming from which interface.
5519 pObj->ioctl_if_type = INT_MAIN;
5520 pObj->ioctl_if = MAIN_MBSSID;
5521 }
5522
5523 switch(cmd)
5524 {
5525 #ifdef RALINK_ATE
5526 #ifdef RALINK_28xx_QA
5527 case RTPRIV_IOCTL_ATE:
5528 {
5529 RtmpDoAte(pAd, wrq);
5530 }
5531 break;
5532 #endif // RALINK_28xx_QA //
5533 #endif // RALINK_ATE //
5534 case SIOCGIFHWADDR:
5535 DBGPRINT(RT_DEBUG_TRACE, ("IOCTL::SIOCGIFHWADDR\n"));
5536 memcpy(wrq->u.name, pAd->CurrentAddress, ETH_ALEN);
5537 break;
5538 case SIOCGIWNAME:
5539 {
5540 char *name=&wrq->u.name[0];
5541 rt_ioctl_giwname(net_dev, NULL, name, NULL);
5542 break;
5543 }
5544 case SIOCGIWESSID: //Get ESSID
5545 {
5546 struct iw_point *essid=&wrq->u.essid;
5547 rt_ioctl_giwessid(net_dev, NULL, essid, essid->pointer);
5548 break;
5549 }
5550 case SIOCSIWESSID: //Set ESSID
5551 {
5552 struct iw_point *essid=&wrq->u.essid;
5553 rt_ioctl_siwessid(net_dev, NULL, essid, essid->pointer);
5554 break;
5555 }
5556 case SIOCSIWNWID: // set network id (the cell)
5557 case SIOCGIWNWID: // get network id
5558 Status = -EOPNOTSUPP;
5559 break;
5560 case SIOCSIWFREQ: //set channel/frequency (Hz)
5561 {
5562 struct iw_freq *freq=&wrq->u.freq;
5563 rt_ioctl_siwfreq(net_dev, NULL, freq, NULL);
5564 break;
5565 }
5566 case SIOCGIWFREQ: // get channel/frequency (Hz)
5567 {
5568 struct iw_freq *freq=&wrq->u.freq;
5569 rt_ioctl_giwfreq(net_dev, NULL, freq, NULL);
5570 break;
5571 }
5572 case SIOCSIWNICKN: //set node name/nickname
5573 {
5574 struct iw_point *data=&wrq->u.data;
5575 rt_ioctl_siwnickn(net_dev, NULL, data, NULL);
5576 break;
5577 }
5578 case SIOCGIWNICKN: //get node name/nickname
5579 {
5580 struct iw_point *data=&wrq->u.data;
5581 rt_ioctl_giwnickn(net_dev, NULL, data, NULL);
5582 break;
5583 }
5584 case SIOCGIWRATE: //get default bit rate (bps)
5585 rt_ioctl_giwrate(net_dev, NULL, &wrq->u, NULL);
5586 break;
5587 case SIOCSIWRATE: //set default bit rate (bps)
5588 rt_ioctl_siwrate(net_dev, NULL, &wrq->u, NULL);
5589 break;
5590 case SIOCGIWRTS: // get RTS/CTS threshold (bytes)
5591 {
5592 struct iw_param *rts=&wrq->u.rts;
5593 rt_ioctl_giwrts(net_dev, NULL, rts, NULL);
5594 break;
5595 }
5596 case SIOCSIWRTS: //set RTS/CTS threshold (bytes)
5597 {
5598 struct iw_param *rts=&wrq->u.rts;
5599 rt_ioctl_siwrts(net_dev, NULL, rts, NULL);
5600 break;
5601 }
5602 case SIOCGIWFRAG: //get fragmentation thr (bytes)
5603 {
5604 struct iw_param *frag=&wrq->u.frag;
5605 rt_ioctl_giwfrag(net_dev, NULL, frag, NULL);
5606 break;
5607 }
5608 case SIOCSIWFRAG: //set fragmentation thr (bytes)
5609 {
5610 struct iw_param *frag=&wrq->u.frag;
5611 rt_ioctl_siwfrag(net_dev, NULL, frag, NULL);
5612 break;
5613 }
5614 case SIOCGIWENCODE: //get encoding token & mode
5615 {
5616 struct iw_point *erq=&wrq->u.encoding;
5617 if(erq->pointer)
5618 rt_ioctl_giwencode(net_dev, NULL, erq, erq->pointer);
5619 break;
5620 }
5621 case SIOCSIWENCODE: //set encoding token & mode
5622 {
5623 struct iw_point *erq=&wrq->u.encoding;
5624 if(erq->pointer)
5625 rt_ioctl_siwencode(net_dev, NULL, erq, erq->pointer);
5626 break;
5627 }
5628 case SIOCGIWAP: //get access point MAC addresses
5629 {
5630 struct sockaddr *ap_addr=&wrq->u.ap_addr;
5631 rt_ioctl_giwap(net_dev, NULL, ap_addr, ap_addr->sa_data);
5632 break;
5633 }
5634 case SIOCSIWAP: //set access point MAC addresses
5635 {
5636 struct sockaddr *ap_addr=&wrq->u.ap_addr;
5637 rt_ioctl_siwap(net_dev, NULL, ap_addr, ap_addr->sa_data);
5638 break;
5639 }
5640 case SIOCGIWMODE: //get operation mode
5641 {
5642 __u32 *mode=&wrq->u.mode;
5643 rt_ioctl_giwmode(net_dev, NULL, mode, NULL);
5644 break;
5645 }
5646 case SIOCSIWMODE: //set operation mode
5647 {
5648 __u32 *mode=&wrq->u.mode;
5649 rt_ioctl_siwmode(net_dev, NULL, mode, NULL);
5650 break;
5651 }
5652 case SIOCGIWSENS: //get sensitivity (dBm)
5653 case SIOCSIWSENS: //set sensitivity (dBm)
5654 case SIOCGIWPOWER: //get Power Management settings
5655 case SIOCSIWPOWER: //set Power Management settings
5656 case SIOCGIWTXPOW: //get transmit power (dBm)
5657 case SIOCSIWTXPOW: //set transmit power (dBm)
5658 case SIOCGIWRANGE: //Get range of parameters
5659 case SIOCGIWRETRY: //get retry limits and lifetime
5660 case SIOCSIWRETRY: //set retry limits and lifetime
5661 Status = -EOPNOTSUPP;
5662 break;
5663 case RT_PRIV_IOCTL:
5664 subcmd = wrq->u.data.flags;
5665 if( subcmd & OID_GET_SET_TOGGLE)
5666 Status = RTMPSetInformation(pAd, rq, subcmd);
5667 else
5668 Status = RTMPQueryInformation(pAd, rq, subcmd);
5669 break;
5670 case SIOCGIWPRIV:
5671 if (wrq->u.data.pointer)
5672 {
5673 if ( access_ok(VERIFY_WRITE, wrq->u.data.pointer, sizeof(privtab)) != TRUE)
5674 break;
5675 wrq->u.data.length = sizeof(privtab) / sizeof(privtab[0]);
5676 if (copy_to_user(wrq->u.data.pointer, privtab, sizeof(privtab)))
5677 Status = -EFAULT;
5678 }
5679 break;
5680 case RTPRIV_IOCTL_SET:
5681 if(access_ok(VERIFY_READ, wrq->u.data.pointer, wrq->u.data.length) != TRUE)
5682 break;
5683 rt_ioctl_setparam(net_dev, NULL, NULL, wrq->u.data.pointer);
5684 break;
5685 case RTPRIV_IOCTL_GSITESURVEY:
5686 RTMPIoctlGetSiteSurvey(pAd, wrq);
5687 break;
5688 #ifdef DBG
5689 case RTPRIV_IOCTL_MAC:
5690 RTMPIoctlMAC(pAd, wrq);
5691 break;
5692 case RTPRIV_IOCTL_E2P:
5693 RTMPIoctlE2PROM(pAd, wrq);
5694 break;
5695 #endif // DBG //
5696 case SIOCETHTOOL:
5697 break;
5698 default:
5699 DBGPRINT(RT_DEBUG_ERROR, ("IOCTL::unknown IOCTL's cmd = 0x%08x\n", cmd));
5700 Status = -EOPNOTSUPP;
5701 break;
5702 }
5703
5704 if(StateMachineTouched) // Upper layer sent a MLME-related operations
5705 RT28XX_MLME_HANDLER(pAd);
5706
5707 return Status;
5708 }
5709
5710 /*
5711 ==========================================================================
5712 Description:
5713 Set SSID
5714 Return:
5715 TRUE if all parameters are OK, FALSE otherwise
5716 ==========================================================================
5717 */
5718 INT Set_SSID_Proc(
5719 IN PRTMP_ADAPTER pAdapter,
5720 IN PUCHAR arg)
5721 {
5722 NDIS_802_11_SSID Ssid, *pSsid=NULL;
5723 BOOLEAN StateMachineTouched = FALSE;
5724 int success = TRUE;
5725
5726 if( strlen(arg) <= MAX_LEN_OF_SSID)
5727 {
5728 NdisZeroMemory(&Ssid, sizeof(NDIS_802_11_SSID));
5729 if (strlen(arg) != 0)
5730 {
5731 NdisMoveMemory(Ssid.Ssid, arg, strlen(arg));
5732 Ssid.SsidLength = strlen(arg);
5733 }
5734 else //ANY ssid
5735 {
5736 Ssid.SsidLength = 0;
5737 memcpy(Ssid.Ssid, "", 0);
5738 pAdapter->StaCfg.BssType = BSS_INFRA;
5739 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
5740 pAdapter->StaCfg.WepStatus = Ndis802_11EncryptionDisabled;
5741 }
5742 pSsid = &Ssid;
5743
5744 if (pAdapter->Mlme.CntlMachine.CurrState != CNTL_IDLE)
5745 {
5746 RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
5747 DBGPRINT(RT_DEBUG_TRACE, ("!!! MLME busy, reset MLME state machine !!!\n"));
5748 }
5749
5750 pAdapter->MlmeAux.CurrReqIsFromNdis = TRUE;
5751 pAdapter->StaCfg.bScanReqIsFromWebUI = FALSE;
5752 pAdapter->bConfigChanged = TRUE;
5753
5754 MlmeEnqueue(pAdapter,
5755 MLME_CNTL_STATE_MACHINE,
5756 OID_802_11_SSID,
5757 sizeof(NDIS_802_11_SSID),
5758 (VOID *)pSsid);
5759
5760 StateMachineTouched = TRUE;
5761 DBGPRINT(RT_DEBUG_TRACE, ("Set_SSID_Proc::(Len=%d,Ssid=%s)\n", Ssid.SsidLength, Ssid.Ssid));
5762 }
5763 else
5764 success = FALSE;
5765
5766 if (StateMachineTouched) // Upper layer sent a MLME-related operations
5767 RT28XX_MLME_HANDLER(pAdapter);
5768
5769 return success;
5770 }
5771
5772 #ifdef WMM_SUPPORT
5773 /*
5774 ==========================================================================
5775 Description:
5776 Set WmmCapable Enable or Disable
5777 Return:
5778 TRUE if all parameters are OK, FALSE otherwise
5779 ==========================================================================
5780 */
5781 INT Set_WmmCapable_Proc(
5782 IN PRTMP_ADAPTER pAd,
5783 IN PUCHAR arg)
5784 {
5785 BOOLEAN bWmmCapable;
5786
5787 bWmmCapable = simple_strtol(arg, 0, 10);
5788
5789 if ((bWmmCapable == 1)
5790 #ifdef RT2870
5791 && (pAd->NumberOfPipes >= 5)
5792 #endif // RT2870 //
5793 )
5794 pAd->CommonCfg.bWmmCapable = TRUE;
5795 else if (bWmmCapable == 0)
5796 pAd->CommonCfg.bWmmCapable = FALSE;
5797 else
5798 return FALSE; //Invalid argument
5799
5800 DBGPRINT(RT_DEBUG_TRACE, ("Set_WmmCapable_Proc::(bWmmCapable=%d)\n",
5801 pAd->CommonCfg.bWmmCapable));
5802
5803 return TRUE;
5804 }
5805 #endif // WMM_SUPPORT //
5806
5807 /*
5808 ==========================================================================
5809 Description:
5810 Set Network Type(Infrastructure/Adhoc mode)
5811 Return:
5812 TRUE if all parameters are OK, FALSE otherwise
5813 ==========================================================================
5814 */
5815 INT Set_NetworkType_Proc(
5816 IN PRTMP_ADAPTER pAdapter,
5817 IN PUCHAR arg)
5818 {
5819 UINT32 Value = 0;
5820
5821 if (strcmp(arg, "Adhoc") == 0)
5822 {
5823 if (pAdapter->StaCfg.BssType != BSS_ADHOC)
5824 {
5825 // Config has changed
5826 pAdapter->bConfigChanged = TRUE;
5827 if (MONITOR_ON(pAdapter))
5828 {
5829 RTMP_IO_WRITE32(pAdapter, RX_FILTR_CFG, STANORMAL);
5830 RTMP_IO_READ32(pAdapter, MAC_SYS_CTRL, &Value);
5831 Value &= (~0x80);
5832 RTMP_IO_WRITE32(pAdapter, MAC_SYS_CTRL, Value);
5833 OPSTATUS_CLEAR_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED);
5834 pAdapter->StaCfg.bAutoReconnect = TRUE;
5835 LinkDown(pAdapter, FALSE);
5836 }
5837 if (INFRA_ON(pAdapter))
5838 {
5839 //BOOLEAN Cancelled;
5840 // Set the AutoReconnectSsid to prevent it reconnect to old SSID
5841 // Since calling this indicate user don't want to connect to that SSID anymore.
5842 pAdapter->MlmeAux.AutoReconnectSsidLen= 32;
5843 NdisZeroMemory(pAdapter->MlmeAux.AutoReconnectSsid, pAdapter->MlmeAux.AutoReconnectSsidLen);
5844
5845 LinkDown(pAdapter, FALSE);
5846
5847 DBGPRINT(RT_DEBUG_TRACE, ("NDIS_STATUS_MEDIA_DISCONNECT Event BB!\n"));
5848 }
5849 }
5850 pAdapter->StaCfg.BssType = BSS_ADHOC;
5851 pAdapter->net_dev->type = pAdapter->StaCfg.OriDevType;
5852 DBGPRINT(RT_DEBUG_TRACE, ("===>Set_NetworkType_Proc::(AD-HOC)\n"));
5853 }
5854 else if (strcmp(arg, "Infra") == 0)
5855 {
5856 if (pAdapter->StaCfg.BssType != BSS_INFRA)
5857 {
5858 // Config has changed
5859 pAdapter->bConfigChanged = TRUE;
5860 if (MONITOR_ON(pAdapter))
5861 {
5862 RTMP_IO_WRITE32(pAdapter, RX_FILTR_CFG, STANORMAL);
5863 RTMP_IO_READ32(pAdapter, MAC_SYS_CTRL, &Value);
5864 Value &= (~0x80);
5865 RTMP_IO_WRITE32(pAdapter, MAC_SYS_CTRL, Value);
5866 OPSTATUS_CLEAR_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED);
5867 pAdapter->StaCfg.bAutoReconnect = TRUE;
5868 LinkDown(pAdapter, FALSE);
5869 }
5870 if (ADHOC_ON(pAdapter))
5871 {
5872 // Set the AutoReconnectSsid to prevent it reconnect to old SSID
5873 // Since calling this indicate user don't want to connect to that SSID anymore.
5874 pAdapter->MlmeAux.AutoReconnectSsidLen= 32;
5875 NdisZeroMemory(pAdapter->MlmeAux.AutoReconnectSsid, pAdapter->MlmeAux.AutoReconnectSsidLen);
5876
5877 LinkDown(pAdapter, FALSE);
5878 }
5879 }
5880 pAdapter->StaCfg.BssType = BSS_INFRA;
5881 pAdapter->net_dev->type = pAdapter->StaCfg.OriDevType;
5882 DBGPRINT(RT_DEBUG_TRACE, ("===>Set_NetworkType_Proc::(INFRA)\n"));
5883
5884 pAdapter->StaCfg.BssType = BSS_INFRA;
5885 }
5886 else if (strcmp(arg, "Monitor") == 0)
5887 {
5888 UCHAR bbpValue = 0;
5889 BCN_TIME_CFG_STRUC csr;
5890 OPSTATUS_CLEAR_FLAG(pAdapter, fOP_STATUS_INFRA_ON);
5891 OPSTATUS_CLEAR_FLAG(pAdapter, fOP_STATUS_ADHOC_ON);
5892 OPSTATUS_SET_FLAG(pAdapter, fOP_STATUS_MEDIA_STATE_CONNECTED);
5893 // disable all periodic state machine
5894 pAdapter->StaCfg.bAutoReconnect = FALSE;
5895 // reset all mlme state machine
5896 RT28XX_MLME_RESET_STATE_MACHINE(pAdapter);
5897 DBGPRINT(RT_DEBUG_TRACE, ("fOP_STATUS_MEDIA_STATE_CONNECTED \n"));
5898 if (pAdapter->CommonCfg.CentralChannel == 0)
5899 {
5900 #ifdef DOT11_N_SUPPORT
5901 if (pAdapter->CommonCfg.PhyMode == PHY_11AN_MIXED)
5902 pAdapter->CommonCfg.CentralChannel = 36;
5903 else
5904 #endif // DOT11_N_SUPPORT //
5905 pAdapter->CommonCfg.CentralChannel = 6;
5906 }
5907 #ifdef DOT11_N_SUPPORT
5908 else
5909 N_ChannelCheck(pAdapter);
5910 #endif // DOT11_N_SUPPORT //
5911
5912 #ifdef DOT11_N_SUPPORT
5913 if (pAdapter->CommonCfg.PhyMode >= PHY_11ABGN_MIXED &&
5914 pAdapter->CommonCfg.RegTransmitSetting.field.BW == BW_40 &&
5915 pAdapter->CommonCfg.RegTransmitSetting.field.EXTCHA == EXTCHA_ABOVE)
5916 {
5917 // 40MHz ,control channel at lower
5918 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R4, &bbpValue);
5919 bbpValue &= (~0x18);
5920 bbpValue |= 0x10;
5921 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R4, bbpValue);
5922 pAdapter->CommonCfg.BBPCurrentBW = BW_40;
5923 // RX : control channel at lower
5924 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R3, &bbpValue);
5925 bbpValue &= (~0x20);
5926 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R3, bbpValue);
5927
5928 RTMP_IO_READ32(pAdapter, TX_BAND_CFG, &Value);
5929 Value &= 0xfffffffe;
5930 RTMP_IO_WRITE32(pAdapter, TX_BAND_CFG, Value);
5931 pAdapter->CommonCfg.CentralChannel = pAdapter->CommonCfg.Channel + 2;
5932 AsicSwitchChannel(pAdapter, pAdapter->CommonCfg.CentralChannel, FALSE);
5933 AsicLockChannel(pAdapter, pAdapter->CommonCfg.CentralChannel);
5934 DBGPRINT(RT_DEBUG_TRACE, ("BW_40 ,control_channel(%d), CentralChannel(%d) \n",
5935 pAdapter->CommonCfg.Channel,
5936 pAdapter->CommonCfg.CentralChannel));
5937 }
5938 else if (pAdapter->CommonCfg.PhyMode >= PHY_11ABGN_MIXED &&
5939 pAdapter->CommonCfg.RegTransmitSetting.field.BW == BW_40 &&
5940 pAdapter->CommonCfg.RegTransmitSetting.field.EXTCHA == EXTCHA_BELOW)
5941 {
5942 // 40MHz ,control channel at upper
5943 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R4, &bbpValue);
5944 bbpValue &= (~0x18);
5945 bbpValue |= 0x10;
5946 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R4, bbpValue);
5947 pAdapter->CommonCfg.BBPCurrentBW = BW_40;
5948 RTMP_IO_READ32(pAdapter, TX_BAND_CFG, &Value);
5949 Value |= 0x1;
5950 RTMP_IO_WRITE32(pAdapter, TX_BAND_CFG, Value);
5951
5952 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R3, &bbpValue);
5953 bbpValue |= (0x20);
5954 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R3, bbpValue);
5955 pAdapter->CommonCfg.CentralChannel = pAdapter->CommonCfg.Channel - 2;
5956 AsicSwitchChannel(pAdapter, pAdapter->CommonCfg.CentralChannel, FALSE);
5957 AsicLockChannel(pAdapter, pAdapter->CommonCfg.CentralChannel);
5958 DBGPRINT(RT_DEBUG_TRACE, ("BW_40 ,control_channel(%d), CentralChannel(%d) \n",
5959 pAdapter->CommonCfg.Channel,
5960 pAdapter->CommonCfg.CentralChannel));
5961 }
5962 else
5963 #endif // DOT11_N_SUPPORT //
5964 {
5965 // 20MHz
5966 RTMP_BBP_IO_READ8_BY_REG_ID(pAdapter, BBP_R4, &bbpValue);
5967 bbpValue &= (~0x18);
5968 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R4, bbpValue);
5969 pAdapter->CommonCfg.BBPCurrentBW = BW_20;
5970 AsicSwitchChannel(pAdapter, pAdapter->CommonCfg.Channel, FALSE);
5971 AsicLockChannel(pAdapter, pAdapter->CommonCfg.Channel);
5972 DBGPRINT(RT_DEBUG_TRACE, ("BW_20, Channel(%d)\n", pAdapter->CommonCfg.Channel));
5973 }
5974 // Enable Rx with promiscuous reception
5975 RTMP_IO_WRITE32(pAdapter, RX_FILTR_CFG, 0x3);
5976 // ASIC supporsts sniffer function with replacing RSSI with timestamp.
5977 //RTMP_IO_READ32(pAdapter, MAC_SYS_CTRL, &Value);
5978 //Value |= (0x80);
5979 //RTMP_IO_WRITE32(pAdapter, MAC_SYS_CTRL, Value);
5980 // disable sync
5981 RTMP_IO_READ32(pAdapter, BCN_TIME_CFG, &csr.word);
5982 csr.field.bBeaconGen = 0;
5983 csr.field.bTBTTEnable = 0;
5984 csr.field.TsfSyncMode = 0;
5985 RTMP_IO_WRITE32(pAdapter, BCN_TIME_CFG, csr.word);
5986
5987 pAdapter->StaCfg.BssType = BSS_MONITOR;
5988 pAdapter->net_dev->type = ARPHRD_IEEE80211_PRISM; //ARPHRD_IEEE80211; // IEEE80211
5989 DBGPRINT(RT_DEBUG_TRACE, ("===>Set_NetworkType_Proc::(MONITOR)\n"));
5990 }
5991
5992 // Reset Ralink supplicant to not use, it will be set to start when UI set PMK key
5993 pAdapter->StaCfg.WpaState = SS_NOTUSE;
5994
5995 DBGPRINT(RT_DEBUG_TRACE, ("Set_NetworkType_Proc::(NetworkType=%d)\n", pAdapter->StaCfg.BssType));
5996
5997 return TRUE;
5998 }
5999
6000 /*
6001 ==========================================================================
6002 Description:
6003 Set Authentication mode
6004 Return:
6005 TRUE if all parameters are OK, FALSE otherwise
6006 ==========================================================================
6007 */
6008 INT Set_AuthMode_Proc(
6009 IN PRTMP_ADAPTER pAdapter,
6010 IN PUCHAR arg)
6011 {
6012 if ((strcmp(arg, "WEPAUTO") == 0) || (strcmp(arg, "wepauto") == 0))
6013 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeAutoSwitch;
6014 else if ((strcmp(arg, "OPEN") == 0) || (strcmp(arg, "open") == 0))
6015 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeOpen;
6016 else if ((strcmp(arg, "SHARED") == 0) || (strcmp(arg, "shared") == 0))
6017 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeShared;
6018 else if ((strcmp(arg, "WPAPSK") == 0) || (strcmp(arg, "wpapsk") == 0))
6019 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPAPSK;
6020 else if ((strcmp(arg, "WPANONE") == 0) || (strcmp(arg, "wpanone") == 0))
6021 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPANone;
6022 else if ((strcmp(arg, "WPA2PSK") == 0) || (strcmp(arg, "wpa2psk") == 0))
6023 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPA2PSK;
6024 #ifdef WPA_SUPPLICANT_SUPPORT
6025 else if ((strcmp(arg, "WPA") == 0) || (strcmp(arg, "wpa") == 0))
6026 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPA;
6027 else if ((strcmp(arg, "WPA2") == 0) || (strcmp(arg, "wpa2") == 0))
6028 pAdapter->StaCfg.AuthMode = Ndis802_11AuthModeWPA2;
6029 #endif // WPA_SUPPLICANT_SUPPORT //
6030 else
6031 return FALSE;
6032
6033 pAdapter->StaCfg.PortSecured = WPA_802_1X_PORT_NOT_SECURED;
6034
6035 DBGPRINT(RT_DEBUG_TRACE, ("Set_AuthMode_Proc::(AuthMode=%d)\n", pAdapter->StaCfg.AuthMode));
6036
6037 return TRUE;
6038 }
6039
6040 /*
6041 ==========================================================================
6042 Description:
6043 Set Encryption Type
6044 Return:
6045 TRUE if all parameters are OK, FALSE otherwise
6046 ==========================================================================
6047 */
6048 INT Set_EncrypType_Proc(
6049 IN PRTMP_ADAPTER pAdapter,
6050 IN PUCHAR arg)
6051 {
6052 if ((strcmp(arg, "NONE") == 0) || (strcmp(arg, "none") == 0))
6053 {
6054 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6055 return TRUE; // do nothing
6056
6057 pAdapter->StaCfg.WepStatus = Ndis802_11WEPDisabled;
6058 pAdapter->StaCfg.PairCipher = Ndis802_11WEPDisabled;
6059 pAdapter->StaCfg.GroupCipher = Ndis802_11WEPDisabled;
6060 }
6061 else if ((strcmp(arg, "WEP") == 0) || (strcmp(arg, "wep") == 0))
6062 {
6063 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6064 return TRUE; // do nothing
6065
6066 pAdapter->StaCfg.WepStatus = Ndis802_11WEPEnabled;
6067 pAdapter->StaCfg.PairCipher = Ndis802_11WEPEnabled;
6068 pAdapter->StaCfg.GroupCipher = Ndis802_11WEPEnabled;
6069 }
6070 else if ((strcmp(arg, "TKIP") == 0) || (strcmp(arg, "tkip") == 0))
6071 {
6072 if (pAdapter->StaCfg.AuthMode < Ndis802_11AuthModeWPA)
6073 return TRUE; // do nothing
6074
6075 pAdapter->StaCfg.WepStatus = Ndis802_11Encryption2Enabled;
6076 pAdapter->StaCfg.PairCipher = Ndis802_11Encryption2Enabled;
6077 pAdapter->StaCfg.GroupCipher = Ndis802_11Encryption2Enabled;
6078 }
6079 else if ((strcmp(arg, "AES") == 0) || (strcmp(arg, "aes") == 0))
6080 {
6081 if (pAdapter->StaCfg.AuthMode < Ndis802_11AuthModeWPA)
6082 return TRUE; // do nothing
6083
6084 pAdapter->StaCfg.WepStatus = Ndis802_11Encryption3Enabled;
6085 pAdapter->StaCfg.PairCipher = Ndis802_11Encryption3Enabled;
6086 pAdapter->StaCfg.GroupCipher = Ndis802_11Encryption3Enabled;
6087 }
6088 else
6089 return FALSE;
6090
6091 pAdapter->StaCfg.OrigWepStatus = pAdapter->StaCfg.WepStatus;
6092
6093 DBGPRINT(RT_DEBUG_TRACE, ("Set_EncrypType_Proc::(EncrypType=%d)\n", pAdapter->StaCfg.WepStatus));
6094
6095 return TRUE;
6096 }
6097
6098 /*
6099 ==========================================================================
6100 Description:
6101 Set Default Key ID
6102 Return:
6103 TRUE if all parameters are OK, FALSE otherwise
6104 ==========================================================================
6105 */
6106 INT Set_DefaultKeyID_Proc(
6107 IN PRTMP_ADAPTER pAdapter,
6108 IN PUCHAR arg)
6109 {
6110 ULONG KeyIdx;
6111
6112 KeyIdx = simple_strtol(arg, 0, 10);
6113 if((KeyIdx >= 1 ) && (KeyIdx <= 4))
6114 pAdapter->StaCfg.DefaultKeyId = (UCHAR) (KeyIdx - 1 );
6115 else
6116 return FALSE; //Invalid argument
6117
6118 DBGPRINT(RT_DEBUG_TRACE, ("Set_DefaultKeyID_Proc::(DefaultKeyID=%d)\n", pAdapter->StaCfg.DefaultKeyId));
6119
6120 return TRUE;
6121 }
6122
6123 /*
6124 ==========================================================================
6125 Description:
6126 Set WEP KEY1
6127 Return:
6128 TRUE if all parameters are OK, FALSE otherwise
6129 ==========================================================================
6130 */
6131 INT Set_Key1_Proc(
6132 IN PRTMP_ADAPTER pAdapter,
6133 IN PUCHAR arg)
6134 {
6135 int KeyLen;
6136 int i;
6137 UCHAR CipherAlg=CIPHER_WEP64;
6138
6139 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6140 return TRUE; // do nothing
6141
6142 KeyLen = strlen(arg);
6143
6144 switch (KeyLen)
6145 {
6146 case 5: //wep 40 Ascii type
6147 pAdapter->SharedKey[BSS0][0].KeyLen = KeyLen;
6148 memcpy(pAdapter->SharedKey[BSS0][0].Key, arg, KeyLen);
6149 CipherAlg = CIPHER_WEP64;
6150 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key1_Proc::(Key1=%s and type=%s)\n", arg, "Ascii"));
6151 break;
6152 case 10: //wep 40 Hex type
6153 for(i=0; i < KeyLen; i++)
6154 {
6155 if( !isxdigit(*(arg+i)) )
6156 return FALSE; //Not Hex value;
6157 }
6158 pAdapter->SharedKey[BSS0][0].KeyLen = KeyLen / 2 ;
6159 AtoH(arg, pAdapter->SharedKey[BSS0][0].Key, KeyLen / 2);
6160 CipherAlg = CIPHER_WEP64;
6161 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key1_Proc::(Key1=%s and type=%s)\n", arg, "Hex"));
6162 break;
6163 case 13: //wep 104 Ascii type
6164 pAdapter->SharedKey[BSS0][0].KeyLen = KeyLen;
6165 memcpy(pAdapter->SharedKey[BSS0][0].Key, arg, KeyLen);
6166 CipherAlg = CIPHER_WEP128;
6167 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key1_Proc::(Key1=%s and type=%s)\n", arg, "Ascii"));
6168 break;
6169 case 26: //wep 104 Hex type
6170 for(i=0; i < KeyLen; i++)
6171 {
6172 if( !isxdigit(*(arg+i)) )
6173 return FALSE; //Not Hex value;
6174 }
6175 pAdapter->SharedKey[BSS0][0].KeyLen = KeyLen / 2 ;
6176 AtoH(arg, pAdapter->SharedKey[BSS0][0].Key, KeyLen / 2);
6177 CipherAlg = CIPHER_WEP128;
6178 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key1_Proc::(Key1=%s and type=%s)\n", arg, "Hex"));
6179 break;
6180 default: //Invalid argument
6181 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key1_Proc::Invalid argument (=%s)\n", arg));
6182 return FALSE;
6183 }
6184
6185 pAdapter->SharedKey[BSS0][0].CipherAlg = CipherAlg;
6186
6187 // Set keys (into ASIC)
6188 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6189 ; // not support
6190 else // Old WEP stuff
6191 {
6192 AsicAddSharedKeyEntry(pAdapter,
6193 0,
6194 0,
6195 pAdapter->SharedKey[BSS0][0].CipherAlg,
6196 pAdapter->SharedKey[BSS0][0].Key,
6197 NULL,
6198 NULL);
6199 }
6200
6201 return TRUE;
6202 }
6203 /*
6204 ==========================================================================
6205
6206 Description:
6207 Set WEP KEY2
6208 Return:
6209 TRUE if all parameters are OK, FALSE otherwise
6210 ==========================================================================
6211 */
6212 INT Set_Key2_Proc(
6213 IN PRTMP_ADAPTER pAdapter,
6214 IN PUCHAR arg)
6215 {
6216 int KeyLen;
6217 int i;
6218 UCHAR CipherAlg=CIPHER_WEP64;
6219
6220 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6221 return TRUE; // do nothing
6222
6223 KeyLen = strlen(arg);
6224
6225 switch (KeyLen)
6226 {
6227 case 5: //wep 40 Ascii type
6228 pAdapter->SharedKey[BSS0][1].KeyLen = KeyLen;
6229 memcpy(pAdapter->SharedKey[BSS0][1].Key, arg, KeyLen);
6230 CipherAlg = CIPHER_WEP64;
6231 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key2_Proc::(Key2=%s and type=%s)\n", arg, "Ascii"));
6232 break;
6233 case 10: //wep 40 Hex type
6234 for(i=0; i < KeyLen; i++)
6235 {
6236 if( !isxdigit(*(arg+i)) )
6237 return FALSE; //Not Hex value;
6238 }
6239 pAdapter->SharedKey[BSS0][1].KeyLen = KeyLen / 2 ;
6240 AtoH(arg, pAdapter->SharedKey[BSS0][1].Key, KeyLen / 2);
6241 CipherAlg = CIPHER_WEP64;
6242 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key2_Proc::(Key2=%s and type=%s)\n", arg, "Hex"));
6243 break;
6244 case 13: //wep 104 Ascii type
6245 pAdapter->SharedKey[BSS0][1].KeyLen = KeyLen;
6246 memcpy(pAdapter->SharedKey[BSS0][1].Key, arg, KeyLen);
6247 CipherAlg = CIPHER_WEP128;
6248 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key2_Proc::(Key2=%s and type=%s)\n", arg, "Ascii"));
6249 break;
6250 case 26: //wep 104 Hex type
6251 for(i=0; i < KeyLen; i++)
6252 {
6253 if( !isxdigit(*(arg+i)) )
6254 return FALSE; //Not Hex value;
6255 }
6256 pAdapter->SharedKey[BSS0][1].KeyLen = KeyLen / 2 ;
6257 AtoH(arg, pAdapter->SharedKey[BSS0][1].Key, KeyLen / 2);
6258 CipherAlg = CIPHER_WEP128;
6259 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key2_Proc::(Key2=%s and type=%s)\n", arg, "Hex"));
6260 break;
6261 default: //Invalid argument
6262 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key2_Proc::Invalid argument (=%s)\n", arg));
6263 return FALSE;
6264 }
6265 pAdapter->SharedKey[BSS0][1].CipherAlg = CipherAlg;
6266
6267 // Set keys (into ASIC)
6268 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6269 ; // not support
6270 else // Old WEP stuff
6271 {
6272 AsicAddSharedKeyEntry(pAdapter,
6273 0,
6274 1,
6275 pAdapter->SharedKey[BSS0][1].CipherAlg,
6276 pAdapter->SharedKey[BSS0][1].Key,
6277 NULL,
6278 NULL);
6279 }
6280
6281 return TRUE;
6282 }
6283 /*
6284 ==========================================================================
6285 Description:
6286 Set WEP KEY3
6287 Return:
6288 TRUE if all parameters are OK, FALSE otherwise
6289 ==========================================================================
6290 */
6291 INT Set_Key3_Proc(
6292 IN PRTMP_ADAPTER pAdapter,
6293 IN PUCHAR arg)
6294 {
6295 int KeyLen;
6296 int i;
6297 UCHAR CipherAlg=CIPHER_WEP64;
6298
6299 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6300 return TRUE; // do nothing
6301
6302 KeyLen = strlen(arg);
6303
6304 switch (KeyLen)
6305 {
6306 case 5: //wep 40 Ascii type
6307 pAdapter->SharedKey[BSS0][2].KeyLen = KeyLen;
6308 memcpy(pAdapter->SharedKey[BSS0][2].Key, arg, KeyLen);
6309 CipherAlg = CIPHER_WEP64;
6310 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key3_Proc::(Key3=%s and type=Ascii)\n", arg));
6311 break;
6312 case 10: //wep 40 Hex type
6313 for(i=0; i < KeyLen; i++)
6314 {
6315 if( !isxdigit(*(arg+i)) )
6316 return FALSE; //Not Hex value;
6317 }
6318 pAdapter->SharedKey[BSS0][2].KeyLen = KeyLen / 2 ;
6319 AtoH(arg, pAdapter->SharedKey[BSS0][2].Key, KeyLen / 2);
6320 CipherAlg = CIPHER_WEP64;
6321 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key3_Proc::(Key3=%s and type=Hex)\n", arg));
6322 break;
6323 case 13: //wep 104 Ascii type
6324 pAdapter->SharedKey[BSS0][2].KeyLen = KeyLen;
6325 memcpy(pAdapter->SharedKey[BSS0][2].Key, arg, KeyLen);
6326 CipherAlg = CIPHER_WEP128;
6327 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key3_Proc::(Key3=%s and type=Ascii)\n", arg));
6328 break;
6329 case 26: //wep 104 Hex type
6330 for(i=0; i < KeyLen; i++)
6331 {
6332 if( !isxdigit(*(arg+i)) )
6333 return FALSE; //Not Hex value;
6334 }
6335 pAdapter->SharedKey[BSS0][2].KeyLen = KeyLen / 2 ;
6336 AtoH(arg, pAdapter->SharedKey[BSS0][2].Key, KeyLen / 2);
6337 CipherAlg = CIPHER_WEP128;
6338 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key3_Proc::(Key3=%s and type=Hex)\n", arg));
6339 break;
6340 default: //Invalid argument
6341 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key3_Proc::Invalid argument (=%s)\n", arg));
6342 return FALSE;
6343 }
6344 pAdapter->SharedKey[BSS0][2].CipherAlg = CipherAlg;
6345
6346 // Set keys (into ASIC)
6347 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6348 ; // not support
6349 else // Old WEP stuff
6350 {
6351 AsicAddSharedKeyEntry(pAdapter,
6352 0,
6353 2,
6354 pAdapter->SharedKey[BSS0][2].CipherAlg,
6355 pAdapter->SharedKey[BSS0][2].Key,
6356 NULL,
6357 NULL);
6358 }
6359
6360 return TRUE;
6361 }
6362 /*
6363 ==========================================================================
6364 Description:
6365 Set WEP KEY4
6366 Return:
6367 TRUE if all parameters are OK, FALSE otherwise
6368 ==========================================================================
6369 */
6370 INT Set_Key4_Proc(
6371 IN PRTMP_ADAPTER pAdapter,
6372 IN PUCHAR arg)
6373 {
6374 int KeyLen;
6375 int i;
6376 UCHAR CipherAlg=CIPHER_WEP64;
6377
6378 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6379 return TRUE; // do nothing
6380
6381 KeyLen = strlen(arg);
6382
6383 switch (KeyLen)
6384 {
6385 case 5: //wep 40 Ascii type
6386 pAdapter->SharedKey[BSS0][3].KeyLen = KeyLen;
6387 memcpy(pAdapter->SharedKey[BSS0][3].Key, arg, KeyLen);
6388 CipherAlg = CIPHER_WEP64;
6389 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key4_Proc::(Key4=%s and type=%s)\n", arg, "Ascii"));
6390 break;
6391 case 10: //wep 40 Hex type
6392 for(i=0; i < KeyLen; i++)
6393 {
6394 if( !isxdigit(*(arg+i)) )
6395 return FALSE; //Not Hex value;
6396 }
6397 pAdapter->SharedKey[BSS0][3].KeyLen = KeyLen / 2 ;
6398 AtoH(arg, pAdapter->SharedKey[BSS0][3].Key, KeyLen / 2);
6399 CipherAlg = CIPHER_WEP64;
6400 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key4_Proc::(Key4=%s and type=%s)\n", arg, "Hex"));
6401 break;
6402 case 13: //wep 104 Ascii type
6403 pAdapter->SharedKey[BSS0][3].KeyLen = KeyLen;
6404 memcpy(pAdapter->SharedKey[BSS0][3].Key, arg, KeyLen);
6405 CipherAlg = CIPHER_WEP128;
6406 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key4_Proc::(Key4=%s and type=%s)\n", arg, "Ascii"));
6407 break;
6408 case 26: //wep 104 Hex type
6409 for(i=0; i < KeyLen; i++)
6410 {
6411 if( !isxdigit(*(arg+i)) )
6412 return FALSE; //Not Hex value;
6413 }
6414 pAdapter->SharedKey[BSS0][3].KeyLen = KeyLen / 2 ;
6415 AtoH(arg, pAdapter->SharedKey[BSS0][3].Key, KeyLen / 2);
6416 CipherAlg = CIPHER_WEP128;
6417 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key4_Proc::(Key4=%s and type=%s)\n", arg, "Hex"));
6418 break;
6419 default: //Invalid argument
6420 DBGPRINT(RT_DEBUG_TRACE, ("Set_Key4_Proc::Invalid argument (=%s)\n", arg));
6421 return FALSE;
6422 }
6423 pAdapter->SharedKey[BSS0][3].CipherAlg = CipherAlg;
6424
6425 // Set keys (into ASIC)
6426 if (pAdapter->StaCfg.AuthMode >= Ndis802_11AuthModeWPA)
6427 ; // not support
6428 else // Old WEP stuff
6429 {
6430 AsicAddSharedKeyEntry(pAdapter,
6431 0,
6432 3,
6433 pAdapter->SharedKey[BSS0][3].CipherAlg,
6434 pAdapter->SharedKey[BSS0][3].Key,
6435 NULL,
6436 NULL);
6437 }
6438
6439 return TRUE;
6440 }
6441
6442 /*
6443 ==========================================================================
6444 Description:
6445 Set WPA PSK key
6446 Return:
6447 TRUE if all parameters are OK, FALSE otherwise
6448 ==========================================================================
6449 */
6450 INT Set_WPAPSK_Proc(
6451 IN PRTMP_ADAPTER pAdapter,
6452 IN PUCHAR arg)
6453 {
6454 UCHAR keyMaterial[40];
6455
6456 if ((pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPAPSK) &&
6457 (pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPA2PSK) &&
6458 (pAdapter->StaCfg.AuthMode != Ndis802_11AuthModeWPANone)
6459 )
6460 return TRUE; // do nothing
6461
6462 DBGPRINT(RT_DEBUG_TRACE, ("Set_WPAPSK_Proc::(WPAPSK=%s)\n", arg));
6463
6464 NdisZeroMemory(keyMaterial, 40);
6465
6466 if ((strlen(arg) < 8) || (strlen(arg) > 64))
6467 {
6468 DBGPRINT(RT_DEBUG_TRACE, ("Set failed!!(WPAPSK=%s), WPAPSK key-string required 8 ~ 64 characters \n", arg));
6469 return FALSE;
6470 }
6471
6472 if (strlen(arg) == 64)
6473 {
6474 AtoH(arg, keyMaterial, 32);
6475 NdisMoveMemory(pAdapter->StaCfg.PMK, keyMaterial, 32);
6476
6477 }
6478 else
6479 {
6480 PasswordHash((char *)arg, pAdapter->MlmeAux.Ssid, pAdapter->MlmeAux.SsidLen, keyMaterial);
6481 NdisMoveMemory(pAdapter->StaCfg.PMK, keyMaterial, 32);
6482 }
6483
6484
6485
6486 if(pAdapter->StaCfg.BssType == BSS_ADHOC &&
6487 pAdapter->StaCfg.AuthMode == Ndis802_11AuthModeWPANone)
6488 {
6489 pAdapter->StaCfg.WpaState = SS_NOTUSE;
6490 }
6491 else
6492 {
6493 // Start STA supplicant state machine
6494 pAdapter->StaCfg.WpaState = SS_START;
6495 }
6496
6497 return TRUE;
6498 }
6499
6500 /*
6501 ==========================================================================
6502 Description:
6503 Set Power Saving mode
6504 Return:
6505 TRUE if all parameters are OK, FALSE otherwise
6506 ==========================================================================
6507 */
6508 INT Set_PSMode_Proc(
6509 IN PRTMP_ADAPTER pAdapter,
6510 IN PUCHAR arg)
6511 {
6512 if (pAdapter->StaCfg.BssType == BSS_INFRA)
6513 {
6514 if ((strcmp(arg, "Max_PSP") == 0) ||
6515 (strcmp(arg, "max_psp") == 0) ||
6516 (strcmp(arg, "MAX_PSP") == 0))
6517 {
6518 // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
6519 // to exclude certain situations.
6520 if (pAdapter->StaCfg.bWindowsACCAMEnable == FALSE)
6521 pAdapter->StaCfg.WindowsPowerMode = Ndis802_11PowerModeMAX_PSP;
6522 pAdapter->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeMAX_PSP;
6523 OPSTATUS_SET_FLAG(pAdapter, fOP_STATUS_RECEIVE_DTIM);
6524 pAdapter->StaCfg.DefaultListenCount = 5;
6525
6526 }
6527 else if ((strcmp(arg, "Fast_PSP") == 0) ||
6528 (strcmp(arg, "fast_psp") == 0) ||
6529 (strcmp(arg, "FAST_PSP") == 0))
6530 {
6531 // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
6532 // to exclude certain situations.
6533 OPSTATUS_SET_FLAG(pAdapter, fOP_STATUS_RECEIVE_DTIM);
6534 if (pAdapter->StaCfg.bWindowsACCAMEnable == FALSE)
6535 pAdapter->StaCfg.WindowsPowerMode = Ndis802_11PowerModeFast_PSP;
6536 pAdapter->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeFast_PSP;
6537 pAdapter->StaCfg.DefaultListenCount = 3;
6538 }
6539 else if ((strcmp(arg, "Legacy_PSP") == 0) ||
6540 (strcmp(arg, "legacy_psp") == 0) ||
6541 (strcmp(arg, "LEGACY_PSP") == 0))
6542 {
6543 // do NOT turn on PSM bit here, wait until MlmeCheckForPsmChange()
6544 // to exclude certain situations.
6545 OPSTATUS_SET_FLAG(pAdapter, fOP_STATUS_RECEIVE_DTIM);
6546 if (pAdapter->StaCfg.bWindowsACCAMEnable == FALSE)
6547 pAdapter->StaCfg.WindowsPowerMode = Ndis802_11PowerModeLegacy_PSP;
6548 pAdapter->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeLegacy_PSP;
6549 pAdapter->StaCfg.DefaultListenCount = 3;
6550 }
6551 else
6552 {
6553 //Default Ndis802_11PowerModeCAM
6554 // clear PSM bit immediately
6555 MlmeSetPsmBit(pAdapter, PWR_ACTIVE);
6556 OPSTATUS_SET_FLAG(pAdapter, fOP_STATUS_RECEIVE_DTIM);
6557 if (pAdapter->StaCfg.bWindowsACCAMEnable == FALSE)
6558 pAdapter->StaCfg.WindowsPowerMode = Ndis802_11PowerModeCAM;
6559 pAdapter->StaCfg.WindowsBatteryPowerMode = Ndis802_11PowerModeCAM;
6560 }
6561
6562 DBGPRINT(RT_DEBUG_TRACE, ("Set_PSMode_Proc::(PSMode=%ld)\n", pAdapter->StaCfg.WindowsPowerMode));
6563 }
6564 else
6565 return FALSE;
6566
6567
6568 return TRUE;
6569 }
6570
6571 #ifdef WPA_SUPPLICANT_SUPPORT
6572 /*
6573 ==========================================================================
6574 Description:
6575 Set WpaSupport flag.
6576 Value:
6577 0: Driver ignore wpa_supplicant.
6578 1: wpa_supplicant initiates scanning and AP selection.
6579 2: driver takes care of scanning, AP selection, and IEEE 802.11 association parameters.
6580 Return:
6581 TRUE if all parameters are OK, FALSE otherwise
6582 ==========================================================================
6583 */
6584 INT Set_Wpa_Support(
6585 IN PRTMP_ADAPTER pAd,
6586 IN PUCHAR arg)
6587 {
6588
6589 if ( simple_strtol(arg, 0, 10) == 0)
6590 pAd->StaCfg.WpaSupplicantUP = WPA_SUPPLICANT_DISABLE;
6591 else if ( simple_strtol(arg, 0, 10) == 1)
6592 pAd->StaCfg.WpaSupplicantUP = WPA_SUPPLICANT_ENABLE;
6593 else if ( simple_strtol(arg, 0, 10) == 2)
6594 pAd->StaCfg.WpaSupplicantUP = WPA_SUPPLICANT_ENABLE_WITH_WEB_UI;
6595 else
6596 pAd->StaCfg.WpaSupplicantUP = WPA_SUPPLICANT_DISABLE;
6597
6598 DBGPRINT(RT_DEBUG_TRACE, ("Set_Wpa_Support::(WpaSupplicantUP=%d)\n", pAd->StaCfg.WpaSupplicantUP));
6599
6600 return TRUE;
6601 }
6602 #endif // WPA_SUPPLICANT_SUPPORT //
6603
6604 #ifdef DBG
6605 /*
6606 ==========================================================================
6607 Description:
6608 Read / Write MAC
6609 Arguments:
6610 pAdapter Pointer to our adapter
6611 wrq Pointer to the ioctl argument
6612
6613 Return Value:
6614 None
6615
6616 Note:
6617 Usage:
6618 1.) iwpriv ra0 mac 0 ==> read MAC where Addr=0x0
6619 2.) iwpriv ra0 mac 0=12 ==> write MAC where Addr=0x0, value=12
6620 ==========================================================================
6621 */
6622 VOID RTMPIoctlMAC(
6623 IN PRTMP_ADAPTER pAdapter,
6624 IN struct iwreq *wrq)
6625 {
6626 CHAR *this_char;
6627 CHAR *value;
6628 INT j = 0, k = 0;
6629 CHAR msg[1024];
6630 CHAR arg[255];
6631 ULONG macAddr = 0;
6632 UCHAR temp[16], temp2[16];
6633 UINT32 macValue = 0;
6634 INT Status;
6635
6636
6637 memset(msg, 0x00, 1024);
6638 if (wrq->u.data.length > 1) //No parameters.
6639 {
6640 Status = copy_from_user(arg, wrq->u.data.pointer, (wrq->u.data.length > 255) ? 255 : wrq->u.data.length);
6641 sprintf(msg, "\n");
6642
6643 //Parsing Read or Write
6644 this_char = arg;
6645 if (!*this_char)
6646 goto next;
6647
6648 if ((value = rtstrchr(this_char, '=')) != NULL)
6649 *value++ = 0;
6650
6651 if (!value || !*value)
6652 { //Read
6653 // Sanity check
6654 if(strlen(this_char) > 4)
6655 goto next;
6656
6657 j = strlen(this_char);
6658 while(j-- > 0)
6659 {
6660 if(this_char[j] > 'f' || this_char[j] < '0')
6661 return;
6662 }
6663
6664 // Mac Addr
6665 k = j = strlen(this_char);
6666 while(j-- > 0)
6667 {
6668 this_char[4-k+j] = this_char[j];
6669 }
6670
6671 while(k < 4)
6672 this_char[3-k++]='0';
6673 this_char[4]='\0';
6674
6675 if(strlen(this_char) == 4)
6676 {
6677 AtoH(this_char, temp, 2);
6678 macAddr = *temp*256 + temp[1];
6679 if (macAddr < 0xFFFF)
6680 {
6681 RTMP_IO_READ32(pAdapter, macAddr, &macValue);
6682 DBGPRINT(RT_DEBUG_TRACE, ("MacAddr=%lx, MacValue=%x\n", macAddr, macValue));
6683 sprintf(msg+strlen(msg), "[0x%08lX]:%08X ", macAddr , macValue);
6684 }
6685 else
6686 {//Invalid parametes, so default printk all bbp
6687 goto next;
6688 }
6689 }
6690 }
6691 else
6692 { //Write
6693 memcpy(&temp2, value, strlen(value));
6694 temp2[strlen(value)] = '\0';
6695
6696 // Sanity check
6697 if((strlen(this_char) > 4) || strlen(temp2) > 8)
6698 goto next;
6699
6700 j = strlen(this_char);
6701 while(j-- > 0)
6702 {
6703 if(this_char[j] > 'f' || this_char[j] < '0')
6704 return;
6705 }
6706
6707 j = strlen(temp2);
6708 while(j-- > 0)
6709 {
6710 if(temp2[j] > 'f' || temp2[j] < '0')
6711 return;
6712 }
6713
6714 //MAC Addr
6715 k = j = strlen(this_char);
6716 while(j-- > 0)
6717 {
6718 this_char[4-k+j] = this_char[j];
6719 }
6720
6721 while(k < 4)
6722 this_char[3-k++]='0';
6723 this_char[4]='\0';
6724
6725 //MAC value
6726 k = j = strlen(temp2);
6727 while(j-- > 0)
6728 {
6729 temp2[8-k+j] = temp2[j];
6730 }
6731
6732 while(k < 8)
6733 temp2[7-k++]='0';
6734 temp2[8]='\0';
6735
6736 {
6737 AtoH(this_char, temp, 2);
6738 macAddr = *temp*256 + temp[1];
6739
6740 AtoH(temp2, temp, 4);
6741 macValue = *temp*256*256*256 + temp[1]*256*256 + temp[2]*256 + temp[3];
6742
6743 // debug mode
6744 if (macAddr == (HW_DEBUG_SETTING_BASE + 4))
6745 {
6746 // 0x2bf4: byte0 non-zero: enable R17 tuning, 0: disable R17 tuning
6747 if (macValue & 0x000000ff)
6748 {
6749 pAdapter->BbpTuning.bEnable = TRUE;
6750 DBGPRINT(RT_DEBUG_TRACE,("turn on R17 tuning\n"));
6751 }
6752 else
6753 {
6754 UCHAR R66;
6755 pAdapter->BbpTuning.bEnable = FALSE;
6756 R66 = 0x26 + GET_LNA_GAIN(pAdapter);
6757 #ifdef RALINK_ATE
6758 if (ATE_ON(pAdapter))
6759 {
6760 ATE_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R66, (0x26 + GET_LNA_GAIN(pAdapter)));
6761 }
6762 else
6763 #endif // RALINK_ATE //
6764 RTMP_BBP_IO_WRITE8_BY_REG_ID(pAdapter, BBP_R66, (0x26 + GET_LNA_GAIN(pAdapter)));
6765 DBGPRINT(RT_DEBUG_TRACE,("turn off R17 tuning, restore to 0x%02x\n", R66));
6766 }
6767 return;
6768 }
6769
6770 DBGPRINT(RT_DEBUG_TRACE, ("MacAddr=%02lx, MacValue=0x%x\n", macAddr, macValue));
6771
6772 RTMP_IO_WRITE32(pAdapter, macAddr, macValue);
6773 sprintf(msg+strlen(msg), "[0x%08lX]:%08X ", macAddr, macValue);
6774 }
6775 }
6776 }
6777 next:
6778 if(strlen(msg) == 1)
6779 sprintf(msg+strlen(msg), "===>Error command format!");
6780
6781 // Copy the information into the user buffer
6782 wrq->u.data.length = strlen(msg);
6783 Status = copy_to_user(wrq->u.data.pointer, msg, wrq->u.data.length);
6784
6785 DBGPRINT(RT_DEBUG_TRACE, ("<==RTMPIoctlMAC\n\n"));
6786 }
6787
6788 /*
6789 ==========================================================================
6790 Description:
6791 Read / Write E2PROM
6792 Arguments:
6793 pAdapter Pointer to our adapter
6794 wrq Pointer to the ioctl argument
6795
6796 Return Value:
6797 None
6798
6799 Note:
6800 Usage:
6801 1.) iwpriv ra0 e2p 0 ==> read E2PROM where Addr=0x0
6802 2.) iwpriv ra0 e2p 0=1234 ==> write E2PROM where Addr=0x0, value=1234
6803 ==========================================================================
6804 */
6805 VOID RTMPIoctlE2PROM(
6806 IN PRTMP_ADAPTER pAdapter,
6807 IN struct iwreq *wrq)
6808 {
6809 CHAR *this_char;
6810 CHAR *value;
6811 INT j = 0, k = 0;
6812 CHAR msg[1024];
6813 CHAR arg[255];
6814 USHORT eepAddr = 0;
6815 UCHAR temp[16], temp2[16];
6816 USHORT eepValue;
6817 int Status;
6818
6819
6820 memset(msg, 0x00, 1024);
6821 if (wrq->u.data.length > 1) //No parameters.
6822 {
6823 Status = copy_from_user(arg, wrq->u.data.pointer, (wrq->u.data.length > 255) ? 255 : wrq->u.data.length);
6824 sprintf(msg, "\n");
6825
6826 //Parsing Read or Write
6827 this_char = arg;
6828
6829
6830 if (!*this_char)
6831 goto next;
6832
6833 if ((value = rtstrchr(this_char, '=')) != NULL)
6834 *value++ = 0;
6835
6836 if (!value || !*value)
6837 { //Read
6838
6839 // Sanity check
6840 if(strlen(this_char) > 4)
6841 goto next;
6842
6843 j = strlen(this_char);
6844 while(j-- > 0)
6845 {
6846 if(this_char[j] > 'f' || this_char[j] < '0')
6847 return;
6848 }
6849
6850 // E2PROM addr
6851 k = j = strlen(this_char);
6852 while(j-- > 0)
6853 {
6854 this_char[4-k+j] = this_char[j];
6855 }
6856
6857 while(k < 4)
6858 this_char[3-k++]='0';
6859 this_char[4]='\0';
6860
6861 if(strlen(this_char) == 4)
6862 {
6863 AtoH(this_char, temp, 2);
6864 eepAddr = *temp*256 + temp[1];
6865 if (eepAddr < 0xFFFF)
6866 {
6867 RT28xx_EEPROM_READ16(pAdapter, eepAddr, eepValue);
6868 sprintf(msg+strlen(msg), "[0x%04X]:0x%04X ", eepAddr , eepValue);
6869 }
6870 else
6871 {//Invalid parametes, so default printk all bbp
6872 goto next;
6873 }
6874 }
6875 }
6876 else
6877 { //Write
6878 memcpy(&temp2, value, strlen(value));
6879 temp2[strlen(value)] = '\0';
6880
6881 // Sanity check
6882 if((strlen(this_char) > 4) || strlen(temp2) > 8)
6883 goto next;
6884
6885 j = strlen(this_char);
6886 while(j-- > 0)
6887 {
6888 if(this_char[j] > 'f' || this_char[j] < '0')
6889 return;
6890 }
6891 j = strlen(temp2);
6892 while(j-- > 0)
6893 {
6894 if(temp2[j] > 'f' || temp2[j] < '0')
6895 return;
6896 }
6897
6898 //MAC Addr
6899 k = j = strlen(this_char);
6900 while(j-- > 0)
6901 {
6902 this_char[4-k+j] = this_char[j];
6903 }
6904
6905 while(k < 4)
6906 this_char[3-k++]='0';
6907 this_char[4]='\0';
6908
6909 //MAC value
6910 k = j = strlen(temp2);
6911 while(j-- > 0)
6912 {
6913 temp2[4-k+j] = temp2[j];
6914 }
6915
6916 while(k < 4)
6917 temp2[3-k++]='0';
6918 temp2[4]='\0';
6919
6920 AtoH(this_char, temp, 2);
6921 eepAddr = *temp*256 + temp[1];
6922
6923 AtoH(temp2, temp, 2);
6924 eepValue = *temp*256 + temp[1];
6925
6926 RT28xx_EEPROM_WRITE16(pAdapter, eepAddr, eepValue);
6927 sprintf(msg+strlen(msg), "[0x%02X]:%02X ", eepAddr, eepValue);
6928 }
6929 }
6930 next:
6931 if(strlen(msg) == 1)
6932 sprintf(msg+strlen(msg), "===>Error command format!");
6933
6934
6935 // Copy the information into the user buffer
6936 wrq->u.data.length = strlen(msg);
6937 Status = copy_to_user(wrq->u.data.pointer, msg, wrq->u.data.length);
6938
6939 DBGPRINT(RT_DEBUG_TRACE, ("<==RTMPIoctlE2PROM\n"));
6940 }
6941 #endif // DBG //
6942
6943
6944
6945
6946 INT Set_TGnWifiTest_Proc(
6947 IN PRTMP_ADAPTER pAd,
6948 IN PUCHAR arg)
6949 {
6950 if (simple_strtol(arg, 0, 10) == 0)
6951 pAd->StaCfg.bTGnWifiTest = FALSE;
6952 else
6953 pAd->StaCfg.bTGnWifiTest = TRUE;
6954
6955 DBGPRINT(RT_DEBUG_TRACE, ("IF Set_TGnWifiTest_Proc::(bTGnWifiTest=%d)\n", pAd->StaCfg.bTGnWifiTest));
6956 return TRUE;
6957 }
6958
6959 INT Set_LongRetryLimit_Proc(
6960 IN PRTMP_ADAPTER pAdapter,
6961 IN PUCHAR arg)
6962 {
6963 TX_RTY_CFG_STRUC tx_rty_cfg;
6964 UCHAR LongRetryLimit = (UCHAR)simple_strtol(arg, 0, 10);
6965
6966 RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
6967 tx_rty_cfg.field.LongRtyLimit = LongRetryLimit;
6968 RTMP_IO_WRITE32(pAdapter, TX_RTY_CFG, tx_rty_cfg.word);
6969 DBGPRINT(RT_DEBUG_TRACE, ("IF Set_LongRetryLimit_Proc::(tx_rty_cfg=0x%x)\n", tx_rty_cfg.word));
6970 return TRUE;
6971 }
6972
6973 INT Set_ShortRetryLimit_Proc(
6974 IN PRTMP_ADAPTER pAdapter,
6975 IN PUCHAR arg)
6976 {
6977 TX_RTY_CFG_STRUC tx_rty_cfg;
6978 UCHAR ShortRetryLimit = (UCHAR)simple_strtol(arg, 0, 10);
6979
6980 RTMP_IO_READ32(pAdapter, TX_RTY_CFG, &tx_rty_cfg.word);
6981 tx_rty_cfg.field.ShortRtyLimit = ShortRetryLimit;
6982 RTMP_IO_WRITE32(pAdapter, TX_RTY_CFG, tx_rty_cfg.word);
6983 DBGPRINT(RT_DEBUG_TRACE, ("IF Set_ShortRetryLimit_Proc::(tx_rty_cfg=0x%x)\n", tx_rty_cfg.word));
6984 return TRUE;
6985 }
6986
6987 #ifdef EXT_BUILD_CHANNEL_LIST
6988 INT Set_Ieee80211dClientMode_Proc(
6989 IN PRTMP_ADAPTER pAdapter,
6990 IN PUCHAR arg)
6991 {
6992 if (simple_strtol(arg, 0, 10) == 0)
6993 pAdapter->StaCfg.IEEE80211dClientMode = Rt802_11_D_None;
6994 else if (simple_strtol(arg, 0, 10) == 1)
6995 pAdapter->StaCfg.IEEE80211dClientMode = Rt802_11_D_Flexible;
6996 else if (simple_strtol(arg, 0, 10) == 2)
6997 pAdapter->StaCfg.IEEE80211dClientMode = Rt802_11_D_Strict;
6998 else
6999 return FALSE;
7000
7001 DBGPRINT(RT_DEBUG_TRACE, ("Set_Ieee802dMode_Proc::(IEEEE0211dMode=%d)\n", pAdapter->StaCfg.IEEE80211dClientMode));
7002 return TRUE;
7003 }
7004 #endif // EXT_BUILD_CHANNEL_LIST //
7005
7006 #ifdef CARRIER_DETECTION_SUPPORT
7007 INT Set_CarrierDetect_Proc(
7008 IN PRTMP_ADAPTER pAd,
7009 IN PUCHAR arg)
7010 {
7011 if (simple_strtol(arg, 0, 10) == 0)
7012 pAd->CommonCfg.CarrierDetect.Enable = FALSE;
7013 else
7014 pAd->CommonCfg.CarrierDetect.Enable = TRUE;
7015
7016 DBGPRINT(RT_DEBUG_TRACE, ("IF Set_CarrierDetect_Proc::(CarrierDetect.Enable=%d)\n", pAd->CommonCfg.CarrierDetect.Enable));
7017 return TRUE;
7018 }
7019 #endif // CARRIER_DETECTION_SUPPORT //
7020
7021
7022 INT Show_Adhoc_MacTable_Proc(
7023 IN PRTMP_ADAPTER pAd,
7024 IN PCHAR extra)
7025 {
7026 INT i;
7027
7028 sprintf(extra, "\n");
7029
7030 #ifdef DOT11_N_SUPPORT
7031 sprintf(extra + strlen(extra), "HT Operating Mode : %d\n", pAd->CommonCfg.AddHTInfo.AddHtInfo2.OperaionMode);
7032 #endif // DOT11_N_SUPPORT //
7033
7034 sprintf(extra + strlen(extra), "\n%-19s%-4s%-4s%-7s%-7s%-7s%-10s%-6s%-6s%-6s%-6s\n",
7035 "MAC", "AID", "BSS", "RSSI0", "RSSI1", "RSSI2", "PhMd", "BW", "MCS", "SGI", "STBC");
7036
7037 for (i=1; i<MAX_LEN_OF_MAC_TABLE; i++)
7038 {
7039 PMAC_TABLE_ENTRY pEntry = &pAd->MacTab.Content[i];
7040
7041 if (strlen(extra) > (IW_PRIV_SIZE_MASK - 30))
7042 break;
7043 if ((pEntry->ValidAsCLI || pEntry->ValidAsApCli) && (pEntry->Sst == SST_ASSOC))
7044 {
7045 sprintf(extra + strlen(extra), "%02X:%02X:%02X:%02X:%02X:%02X ",
7046 pEntry->Addr[0], pEntry->Addr[1], pEntry->Addr[2],
7047 pEntry->Addr[3], pEntry->Addr[4], pEntry->Addr[5]);
7048 sprintf(extra + strlen(extra), "%-4d", (int)pEntry->Aid);
7049 sprintf(extra + strlen(extra), "%-4d", (int)pEntry->apidx);
7050 sprintf(extra + strlen(extra), "%-7d", pEntry->RssiSample.AvgRssi0);
7051 sprintf(extra + strlen(extra), "%-7d", pEntry->RssiSample.AvgRssi1);
7052 sprintf(extra + strlen(extra), "%-7d", pEntry->RssiSample.AvgRssi2);
7053 sprintf(extra + strlen(extra), "%-10s", GetPhyMode(pEntry->HTPhyMode.field.MODE));
7054 sprintf(extra + strlen(extra), "%-6s", GetBW(pEntry->HTPhyMode.field.BW));
7055 sprintf(extra + strlen(extra), "%-6d", pEntry->HTPhyMode.field.MCS);
7056 sprintf(extra + strlen(extra), "%-6d", pEntry->HTPhyMode.field.ShortGI);
7057 sprintf(extra + strlen(extra), "%-6d", pEntry->HTPhyMode.field.STBC);
7058 sprintf(extra + strlen(extra), "%-10d, %d, %d%%\n", pEntry->DebugFIFOCount, pEntry->DebugTxCount,
7059 (pEntry->DebugTxCount) ? ((pEntry->DebugTxCount-pEntry->DebugFIFOCount)*100/pEntry->DebugTxCount) : 0);
7060 sprintf(extra, "%s\n", extra);
7061 }
7062 }
7063
7064 return TRUE;
7065 }
7066
7067
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree